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Appendix  A  -  Exosim  vl.O  Boost  Phase 


A.l  Mainline  (FORTRAN) 

A.  1.1  Aeroca.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  0-7.) 
REAL  calm(205),  ca2m(205) 
REAL  roach,  alfat,  ca 
#include  "include/j'onstant  .dat" 
#include  "include/caln.dat" 
#include  "include/ca2m.dat" 

DATA  icaml/0/,  icaal/0/ 
DATA  icam2/0/,  icaa2/0/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 


10  CONTINUE 

CALL  receive_net_32 (roach) 
CALL  receive  net  32  (alfat) 


IF  (t  .GT.  tstgl)  THEN 
c  second  stage 


CALL  tlu2ei(mach, 
ELSE 

first  Stage 

alfat. 

ca2m. 

icam2. 

icaa2. 

ca) 

CALL  tlu2ei(mach, 
END  IF 

alfat, 

calm. 

icaml, 

icaal, 

ca) 

CALL  send_net_32 (ca) 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinil)  GOTO  10 

END 
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A.  1.2  Aerocn.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 
REAL  cnal(205),  cna2(205) 
REAL  mach,  alfat,  cn 
#include  "include/constant .dat" 
#include  "include/cnal .dat" 
finclude  "include/cna2 .dat" 

DATA  icnml/0/,  icnal/0/ 
DATA  icnm2/0/,  icna2/0/ 

c  initialize  time 
tstep  =0.0 
t  =  tstep  *  delt 


10  CONTINUE 

CALL  receive_real_32bit (mach) 
CALL  receive  real  32bit (alfat) 


IF  (t  .GT.  tstgl)  THEN 
c  second  stage 


CALL  tlu2ei (mach, 
ELSE 

axfat. 

cna2. 

icnm2 , 

icna2, 

cn) 

c  first  stage 

CALL  tlu2ei(mach, 

alfat. 

cnal, 

icnml. 

icnal. 

cn) 

ENDIF 


CALL  send_real_32bit (cn) 

c  increment  time 

tstep  =  tstep  r  1.0 
t  “  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.1.3  Aeroxcp.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  xcpll (205) ,  xcpl2 (205) 
REAL  mach,  alfat,  xcp 
♦include  "include/constant .dat" 
♦include  "include/xcpll .dat" 
♦include  "include/xcpl2 .dat" 

DATA  ixcpml/0/,  ixcpal/0/ 
DATA  ixcpm2/0/,  ixcpa2/0/ 

c  initialize  time 
tstep  =0.0 
t  =  tstep  *  delt 


10  CONTINUE 

CALL  receive_real_32bit (mach) 

CALL  receive_real_32bit (alfat) 

IF  (t  .GT.  tstgl)  THEN 
c  second  stage 

CALL  tlu2ei(mach,  alfat,  xcpl2,  ixcpm2,  ixcpa2,  xcp) 
ELSE 

c  first  stage 

CALL  tlu2ei(mach,  alfat,  xcpll,  ixcpml,  ixcpal,  xcp) 
END  IF 

xcp  =  -  xcp/ 12.0 

CALL  send_real_32bit (xcp) 

c  increment  time 

tstep  =  tstep  +1.0 
t  =  tstep  *  delt 

IF  (t  .1  •.  tfinal)  GOTO  10 

END 
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A.  1.4  Attlm.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 
REAL  attltt(5),  attlmt(5) 
REAL  attlm 

#  ..nclude  "include/constant  .dat" 
#in''.lude  "include/attltt .dat" 
#include  "include/attlmt .dat" 
DATA  itable/0/ 

o  vUtialize  time 
tstep  =  0.0 
c  “  tstep  *  delt 


10  CONTINUE 

CALL  table (attltt,  attlmt,  t,  attlm,  5,  itable) 

CALL  send_real_32bit (attlm) 

c  increment  time 

tstep  “  tstep  +  1.0 
t  »  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.1.5  Bauto.for 


PROGRAM  main 


c 

c 

c 

c 

c 

c 

c 

c 

c 


subroutine  bauto (t, thter,psier, sq, sr, ii, cgest, vrwm, alt, cmmd, 
dlpc,dlyc,mdltfr,malpha) 


function 

inputs  : 
outputs  : 


provides  control  of  the  missile  about  three 
axes  throughout  the  boost  phase  of  flight 
t, thter, psier, sq, sr, ii, cgest, vrwm, alt 
cmmd, dlpc , dlyc , mdl t  f  r , ma Ipha 


IMPLICIT  REAL(a-h,  o-z) 

REAL  cgest (3),  ii{3),  alt,  cne,  xcpe 
REAL  estmch,  alfate 
REAL  cmmd (2) 

REAL  ktht,  kpsi,  kthtd 

REAL  kpsid,  timtel(26),  timte2(29) 

REAL  thrtel (26) ,  thrte2(29),  altte(59) 

REAL  rhote(59),  vrwm(3) 

REAL  Id,  kne,  kme 

REAL  Ifracs,  frcloc(3,  4) 

REAL  kthtkl,  kthtk2 
REAL  krtfrc,  kthfrc 
REAL  kthfml,  kthfm2,  vsndte(59) 

REAL  presste(59),  mchlim,  wmfrtt(4) 

REAL  wmfrct(4) 

REAL  dlpc,  dlyc,  sq,  sr,  mdltfr,  malpha 
finclude  "include/constant .dat" 

# include  "include/ frcloc.dat" 
finclude  "include/altte.dat" 
tinclude  "include/rhote.dat" 

#include  "include/presste.dat" 
tinclude  "include/vsndte.dat" 
tinclude  "include/timtel .dat" 
tinclude  "include/timte2 .dat" 
tinclude  "include/thrtel .dat" 
tinclude  "include/thrte2 .dat" 

DATA  tapu/0.0/,  dtapu/0 . 005/,  tapustep/5 . 0/ 

DATA  mchlim/4.0/,  kthtkl,  kthtk2/.6,  1.5/ 

DATA  tign/0.01/,  tst2on/22 . 995/,  tfrcs/23.0/,  tmode2/23 . 01/ 

DATA  wmtvc/25.0/,  zertvc/O . 85/,  wmfrtt/0.0,  9.5,  39.95,  100./ 

DATA  wmfrct/62.83,  62.83,  42.,  42./,  zetfrc/0 . 85/,  delon/0.045/ 
DATA  bcklmt/0.15/,  delthg/0 . 045/,  thjet/370./,  sjet/1.3273/ 

DATA  srefl/1. 968953/,  sref2/l . 968953/,  aexite/ . 305/,  aexit2/0.99/ 
DATA  xnoze/-12 .5583/,  xnoz2/-7 . 39167/,  djet/1.3/,  xjet/-2.71/ 
DATA  ialte/0/,  ithle/O/,  ith2e/0/,  iwmfrc/0/ 

DATA  dtr/0. 017453292519943296/,  slglbm/32 . 174048/ 


c  initialize  time 
tstep  =0.0 
t  =  tstep  *  delt 


cmmd ( 1 )  =  0.0 
cmmd (2)  =0.0 
dlpc  =  0.0 
dlyc  =  0.0 
mdltfr  =  0.0 
malpha  =  0.0 
sq  =  0.0 
sr  =  0.0 
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10  CONTINUE 

CALL  send_real_32bit (cmmd(l) ) 

CALL  send_real_32bit (cmmd(2) ) 

CALL  send_real_32bit (dlpc) 

CALL  send_real_32bit (dlyc) 

CALL  send_real_32bit (sq) 

CALL  send_real_32bit (sr) 

CALL  send_real_32bit (mdltfr) 

CALL  send_real_32bit (malpha) 

CALL  receive_real_32bit (cgest (1) ) 

CALL  receive_real_32bit (cgest (2) ) 

CALL  receive_real_32bit (cgest (3) ) 

CALL  i.eceive_real_32bit  (ii  (2) ) 

CALL  receive_real_32bit (alt) 

CALL  receive_real_32bit (vrvnn(l) ) 

CALL  receive_real_32bit (vrwm(2) ) 

CALL  receive_real_32bit (vrwm(3) ) 

IF  (tstep  .GE.  tapu)  THEN 
tapu  =  tapu  +  tapustep 

IF  (t  .LT.  tstg2)  THEN 

IF  (abs(t  -  tstgl)  .LE.  dteps)  THEN 
aexite  =  aexit2 
xnoze  =  xnoz2 
END  IF 

estalt  =  alt 

CALL  table (altte,  rhote,  estalt,  estrho,  59,  ialte) 
estrho  =  estrho*! .  Oe-6/slglbin 

CALL  table (altte,  presste,  estalt,  estpre,  59,  ialte) 

CALL  table (altte,  vsndte,  estalt,  estvsd,  59,  ialte) 
estvel  *  sqrt (vrwm(l) **2  +  vrwm(2)**2  +  vrwm(3)**2) 
estmch  •  estvel/estvsd 
estqa  =  estrho*estvel**2/2 .0 
IF  (t  .GT.  tstgl)  THEN 
srefe  =  sref2 
to  =  t  -  tst2on 

CALL  table (titnte2,  thrte2,  tO,  thrve,  29,  ith2e) 

ELSE 

to  =  t  -  tign 
srefe  =  srefl 

CALL  table (timtel,  thrtel,  tO,  thrve,  26,  ithle) 

ENDIF 

thre  =  thrve  -  aexite*estpre 
IF  (thre  .LT.  0.0)  thre  =0.0 
IF  (estvel  .GT.  0.0)  THEN 

alfate  =  sparctan (sqrt (vrwm(2) **2  +  vrwm(3)**2),  abs(vrvnn 
&  (l)))/dtr 

ELSE 

alfate  =  C.O 
ENDIF 

CALL  send_real_32bit (estmch) 

CALL  send_real_32bit (alfate) 
if  (  t. It. tstgl  )  then 

call  tlu2ei (estmch, 4 . OdO, cnale, icnmle, icnale, cne) 
call  tlu2ei (estmch, alfate, xcplle, icpmle, icpale, xcpe) 
else 

call  tlu2ei (estmch, 4 .OdO, cna2e, icnm2e, icnale, cne) 
call  tlu2ei (estmch, alfate, xcpl2e, icpm2e,  icpa2e, xcpe) 
end  if 

CALL  receive_real_32bit (cne) 

CALL  receive_real_32bit (xcpe) 
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c  conversion  from  inches  to  feet 
xcpe  =  -  xcpe/12.0 

c  calculate  cnalfa  (per  radian) 
cnalp  =  cne/ (4.0*dtr) 
xcpcg  =  xcpe  -  cgest ( 1 ) 

IF  (thre  .GE.  1000.0  .AND.  ii{2)  .GT.  l.Oe-6)  malpha  =  abs 
&  (cnalp*xcpcg*srefe*estqa/ii (2) ) 

CALL  receive_real_32bit (psier) 

CALL  receive_real_32bit (thter) 

CALL  receive_real_32bit (sq) 

CALL  receive_real_32bit  (sr) 

c  tvc  autopilot 

IF  (t  .LT.  tmode2)  THEN 

IF  (thre  .GE.  1000.0  .AND.  ii(2)  .GT.  l.Oe-6)  THEN 
xdel  =  cgest (1)  -  xnoze 

ktht  =  (ii (2) *wmtvc**2  +  cnalp*srefe*estqa*xcpcg) / (thre 
&  *xdel) 

kpsi  =  (ii (2) *wmtvc**2  +  cnalp*srefe*estqa*xcpcg) / (thre 
&  *xdel) 

kthtd  =  2 . 0*zettvc*wmtvc*ii (2) / (thre*xdel) 
kpsid  =  2 .0*zettvc*wmtvc*ii (2) / (thre*xdel) 

ELSE 

ktht  =4.0 
kpsi  =4.0 
kthtd  =  4.0 
kpsid  =  4.0 
END  IF 

cmmd(l)  =  thter *ktht  -  sq*kthtd 
cmmd(2)  =  psier*kpsi  -  sr*kpsid 
totcmd  =  sqrt (cmmd(l) **2  +  cmmd(2)**2) 

IF  (totcmd  .GT.  bcklmt)  THEN 
cmmd(l)  =  cmmd(l) *bcklmt /totcmd 
cmmd(2)  =  cmmd (2) *bcklmt /totcmd 
ENDIF 
ELSE 

cmmd ( 1 )  =0.0 
cmmd (2)  =  0.0 
ENDIF 

c  forward  reaction  control  system  autopilot 
IF  (t  .GE.  tfrcs)  THEN 

IF  (thre  .GE.  1000.0  .AND.  ii(2)  .GT.  l.Oe-6)  THEN 
Id  =  (xjet  -  xnoze) /djet 
ct  =  thjet/ (estqa*s jet) 

IF  (estmch  .LE.  mchlim)  THEN 

kne  =  0.6118  +  (0.1358*(1.  -  0 . 485*sqrt (Id) ) /sqrt (ct) ) 
&  +  0.0946*estmch  +  0.004317/ld 

ELSE 

kne  =  1.0  +  expd.l  -  0.2116*  (log(ct)  +  8.5)**1.4) 
ENDIF 

kme  =  0.5582  -  0 . 1884/sqrt (ct)  -  1.9659/ld 
Ifracs  =  frclocd,  1)  -  cgest  (1) 

mdltfr  =  (  -  kme*th jet*djet  +  kne*th jet*lfracs) /ii  (2) 
CALL  table  (wmfrtt,  wmfrct,  t  -  tmode2,  wmfrc,  4, 

&  iwmfrc) 

krtfrc  =  2 . 0*zetfrc*wmfrc/ (wmfrc**2  +  malpha) 

kthfrc  =  2 .0*delon/ (mdltfr*krtfrc*dtapu) 

kthfmi  =  deion*malpha/mdltfr 

kthfm2  =  delon/delthg 

IF  (kthfrc  .LT.  kthfmi)  kthfrc  =  kthfmi 
IF  (kthfrc  .LT.  kthfm2)  kthfro  =  kthfm2 
ktht  =  kthfrc*kthtkl 
kthtd  =  ktht*krtfrc*kthtk2 
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kpsi  =  ktht 
kpsid  =  kthtd 
ELSE 

malpha  =  544.18 
mdltfr  =  6.0437 
ktht  =10.0 
kthtd  =25.0 
kpsi  =10.0 
kpsid  =  25.0 
END  IF 

dlpc  =  thter*ktht  -  sq*kthtd 
dlyc  =  psier*kpsi  -  sr*kpsid 
ENDIF 
ELSE 

CALL  send_real_32bit (estmch) 
CALL  send_real_32bit (alfate) 
CALL  receive_real_32bit (cne) 
CALL  receive_real_32bit (xcpe) 
CALL  receive_real_32bit (psier) 
CALL  receive_real_32bit (thter) 
CALL  receive_real_32bit (sq) 
CALL  receive_real_32bit (sr) 
ENDIF 
ELSE 

CALL  send_real_32bit (estmch) 

CALL  send_real_32bit (alfate) 

CALL  receive_real_32bit (cne) 

CALL  receive_real_32bit (xcpe) 
CALL  receive~real_32bit (psier) 
CALL  receive_real_32bit (thter) 
CALL  receive_real~32bit (sq) 

CALL  receive_real  32bit(sr) 

ENDIF 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 


42 


Appendix  A  ■  Exosim  vl.O  Boost  Phase 


A.1.6  Boost2a.for 

PROGRAM  main 

IMPLICIT  DOUBLEPRECISION (a-h,  o-z) 

REAL  gr(3) 

DOUBLE  PRECISION  latlp,  longlp 
DOUBLE  PRECISION  xyz(3) 

DOUBLE  PRECISION  xyzd(3),  xyzdd(3),  xyze(3) 

DOUBLE  PRECISION  xyzed(3),  xyzedd(3),  cei(9) 

REAL  mdotf,  msstg2,  mass,  massold,  massO 
REAL  frcx,  frcy,  frcz,  alt 
REAL  mdot,  fxt,  fyt,  fzt 
REAL  ud,  vd,  wd,  wkv,  wkvO,  wdotkv 
REAL  cim(9),  mdott,  spt 
REAL  tmp_xyz ( 3 ) 

#include  "include/constant .dat" 

DATA  rade/20898908.0/,  msstg2/19. 457/ 

DATA  dtr/0. 017453292519943296/,  slglbm/32 . 174048/ 

DATA  massO/43.939/,  wkvO/97.1/ 

DATA  latlp/O.O/,  longlp/0.0/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 

DO  10  i  =  1,  3 
xyze(i)  =  0.0 
xyzed(i)  =0.0 
xyzedd(i)  =0.0 
10  CONTINUE 

xyzed)  =  rade 

alt  =  dsqrt (xyze (1) **2  +  xyze(2)**2  +  xyze{3)**2)  -  rade 

c - . 

c - missile  state  initialization  module - 

- - 

c  initialize  states  and  state  derivatives 
mass  =  massO 
wkv  =  wkvO 

CALL  mmk (-90 . 0*dtr,  1,  latlp*dtr,  2,  longlp*dtr,  3,  cei) 

CALL  vecrot (xyzed,  cei,  xyzd) 

CALL  vecrot (xyze,  cei,  xyz) 
mdot  =0.0 
wdotkv  =  0.0 

CALL  vecrot (xyzedd,  cei,  xyzdd) 
spt  =  t 

CALL  spintegi (mass,  mdot,  spc,  1) 

CALL  spintegi (wkv,  wdotkv,  spt,  5) 

CALL  integi  (xyzdd) ,  xyzdd(l),  t,  6) 

CALL  integi (xyzd (2) ,  xyzdd(2),  t,  7) 

CALL  integi (xyzd (3) ,  xyzdd (3),  t,  8) 

CALL  integi  (xyz  (1) ,  xyzdd),  t,  9) 

CALL  integi (xyz (2) ,  xyza(2),  t,  10) 

CALL  integi (xyz (3) ,  xyzd (3),  t,  11) 

- - 

c  initialize  processor  inputs  if  not  already  initialized 
c  pi 

fxt  =  0.0 
fyt  =  0.0 
fzt  =  0.0 
mdott  =  0.0 
frcx  =  0.0 
frcy  =  0.0 
frcz  =  0.0 
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mdotf  =  0.0 

c  p2 
c  p3 

ud  =  0.0 
vd  =  0.0 
wd  =  0.0 

c  p4 

DO  20  i  =  1,  3 
gr  < i )  =  0.0 
20  CONTINUE 
C  p5 

c  initialization  routine 

mass  =  mass  +  delt*mdot 


c 

c 

c 


- c 

main  execution  loop - c 

- c 


30  CONTINUE 

Q-k  it  it  it  ic  it  ic -k  ic  ic -k  it  it  "k  it  it  it  "k  if  if  it  it  it  it -k  it  it  it -k  it  it -k  it  it  it  *  it  it -k  it -k  ■k -k  it -k  it -k -k -k  it  ie  *  it  -k 'k -k  ic  -k  k  "k  ■k  *  ie -k -k  -k  if -k  ic  *  "k 

c  * 

c  partition  1  * 

c  * 

Qk  k  k  k  k  k  k  it  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k 

c - missile  state  update  module - c 

c  temporarily  extrapolate  missile  states  from  last  integration 
c  step  (  note  :  the  extrapolated  states  are  overwritten  when 
c  the  true  integration  is  performed  ) 

c - send  parameters  to  partitions  3,  4,  and  5 - c 

CALL  send_real_32bit (ud) 

CALL  send_real_32bit (vd) 

CALL  send_real_32bit (wd) 

CALL  send~real_32bit (gr ( 1) ) 

CALL  send_real_32bit (gr (2 ) ) 

CALL  send_real_32bit(gr(3)) 

CALL  send~real_32bit (alt) 

c - send  mass  to  masspr  subroutine  table  loo)cup  processors - c 

CALL  send_real_32bit (mass) 
xyzd(l)  =  xyzdd)  +  delt*xyzdd  (1) 
xyzd(2)  =  xy2d(2)  +  delt*xyzdd(2) 
xyzd(3)  =  xyzd(3)  +  delt*xyzdd(3) 
xyz(l)  =  xyz(l)  +  delt*xyzd(l) 
xyz(2)  =  xyz(2)  +  delt*xyzd(2) 
xyz(3)  =  xyz(3)  +  delt*xyzd(3) 
c  calculate  current  missile  altitude 

alt  =  dsqrt (xyz (1) **2  +  xyz(2)**2  +  xyz(3)**2)  -  rade 

c - send  altitude  to  atmos  subroutine  table  loo)cup  processors  -c 

CALL  send_real_32bit (alt) 

c -  send  parameters  to  thread  containing  winds  subroutine  - c 

CALL  send_real_64bit (xyz (1) ) 

CALL  send_:i:eal_64bit  (xyz  (2) ) 

CALL  send_real_64bit (xyz (3) ) 

CALL  send_real_64bit (xyzd(l) ) 

CALL  send__real_64bit  (xyzd(2) ) 

CALL  send”real_64bit (xyzd(3) ) 

CALL  receLve_real_32bit (cim(l) ) 

CALL  receive_real_32bit (cim(2) ) 

CALL  receive_real_32bit (cim(3) ) 

CALL  rec6;ive_real_32bit  (cim(4) ) 

CALL  receive_real_32bit (cim(5) ) 

CALL  receive_real_32bit (cim(6) ) 

CALL  receive_real_32bit (cim(7) ) 

CALL  receive_rear_32bit (cim(8) ) 

CALL  receive_real_32bit (cim(9) ) 

c -  receive  parameters  from  partition  #2  - c 

CALL  receive  real  32bit(fxt) 
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CALL  receive_real_32bit (fyt) 

CALL  receive_real_32bit (fzt) 

CALL  receive_real_32bit (frcx) 

CALL  receive_real_32bit (frcy) 

CALL  receive_real_32bit (frcz) 

CALL  receive_real_32bit (mdott) 

CALL  receive_real_32bit (mdotf ; 
wkv  =  wkv  +  delt*wdotkv 
mdotkv  =  -  mdotf *slglbm 

mdot  =  -  mdott  -  mdotf 

c  save  mass  value  for  use  in  raissil  subroutine 
massold  =  mass 
spt  =  t 

c  trapezoidal  integration  for  simplicity 
IF  (dabs(t  -  tstgl)  .LE.  dteps)  THEN 
c  first  stage  separation 
mass  =  msstg2 

CALL  spintegi (mass,  O.OeO,  spt,  1) 

ELSEIF  (dabs(t  -  tstg2)  .LE.  dteps)  THEN 
c  second  stage  separation 
mass  =  wkv/slglbm 
CALL  spintegi (mass,  O.OeO,  spt,  1) 

ELSE 

CALL  spinteg (mass,  mdot,  spt,  1) 

END  IF 

wkv  =  amaxl (wkv,  O.eO) 

CALL  spinteg (wkv,  wdotkv,  spt,  5) 
mass  =  mass  +  delt*mdot 

c -  vehicle  states  module  - c 

CALL  missiKt,  massold,  fxt,  frcx,  fyt,  frcy,  fzt,  frcz,  xyz, 

&  xyzd,  ud,  vd,  wd,  gr,  cim,  xyzdd) 

c - c 

c  missile  state  integration  module  c 

c - c 

CALL  integ(xyzd(l) ,  xyzdd(l),  t,  6) 

CALL  integ(xyzd(2) ,  xyzdd(2),  t,  7) 

CALL  integ (xyzd (3) ,  xyzdd(3),  t,  8) 

CALL  integ (xyz (1) ,  xyzd(l),  t,  9> 

CALL  integ (xyz (2) ,  xyzd(2),  t,  10) 

CALL  integ (xyz (3) ,  xyzd(3),  t,  11) 
c  calculate  current  missile  altitude 

alt  =  dsqrt (xyz (1) **2  +  xyz(2)**2  +  xyz(3)**2)  -  rade 
tmp_xyz(l)  =  xyz(l) 
tmp_xyz(2)  =  xyz (2) 
tmp_xyz(3)  =  xyz (3) 

CALL  send_real_32bit (tmp_xyz (1) ) 

CALL  send_real_32bit (tmp_xyz (2) ) 

CALL  send_real_32bit (tmp_xyz (3) ) 

CALL  send_real_32bit (alt) 

Qie  i(  ie  ic  ic  -k  it  -k  it  it  ic  it  it  it  ie  it  it  -k  ie  ic  -k  ic  it  if  it  it  -k  -k  ic  if  -k  if  if  ic  i<  -k  -k  -k  it  -k  it  -k  it  -k  -k  it  it  it  it  -k  -k  i(  -k  it  if  if  if  -k  ic  "k  ie  -k  -k  ic  -k  -k  it  ic  it  -k 

c  * 

c  end  of  partition  1  * 

* 

kkkkkkkkkkkkititkkkkkkitkkkkkkitkkkkkkkkkkkkkkkkifkititkkkkkkkitkkkitkkkkkkkitkitk 


c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  30 

END 
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A.1.7  Boost2al.for 

PROGRAM  main 

IMPLICIT  DOUBLEPRECISION (a-h,  o-z) 

DOUBLE  PRECISION  mvrwm,  cir(9) 

DOUBLE  PRECISION  xyzr(3),  xyz(3),  xyzd(3),  xyze(3) 
DOUBLE  PRECISION  cer(9),  cri(9),  cie{9) 

DOUBLE  PRECISION  cei(9),  latlp,  longlp 
DOUBLE  PRECISION  vrwi{3),  cwr(9) 

DOUBLE  PRECISION  vrwind(3),  viwind(3) ,  vwwind{3) 
REAL  fxa,  fya,  fza 

REAL  mach,  alfat,  ca,  cn,  vrwm(3),  qa 
REAL  lat,  long,  rhod2,  vsnd,  cim(9) 

REAL  shear,  swdir,  cwdir,  vwind 
#include  "include/constant .dat" 

DATA  omegae/0.0/,  dtr/0 .017453292519943296/ 

DATA  sref 1/1. 968953/,  sref2/l . 968953/ 

DATA  latlp,  longlp,  tmpl/3*0.0/ 

c  initialize  time 
tstep  =0.0 
t  =  tstep  *  delt 


c - c 

c - missile  state  initialization  module - c 

c - c 

c  initialize  states  and  state  derivatives 

CALL  mmk(-90.0*dtr,  1,  latlp*dtr,  2,  longlp*dtr,  3,  cei) 

CALL  trans (cei,  cie) 


c - 

c  initialize  processor  inputs  if  not  already  initialized 
c  p2 

qa  “  0.0 
mach  =  0.0 

c  p5 

DO  10  i  =  1,  3 
vrwm(i)  =  0.0 
10  CONTINUE 


c - - c 

c - main  execution  loop - c 

c - c 

20  CONTINUE 


Qif  ^  ^  ^  ^  ^  ^  it  it  -k  ic  -k  -k  ^  "k  ic  it  "k  it  "k  ^  it  ^  if  ic  ^  it  it  "k  it  -k  it  if  it  icitit  -k  i:  "k  it  if  it  "k  it  -k  irir  it  -k  if  it  i(  it  it  it  it  ic  if  i(  if  it  it  if  it  it  it  it 

c  * 

c  partition  1  * 

c  * 

Qk  k  it  it  it  k  it  k  it  k  it  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  it  k  k  k  k  k  k  k  k  k  it  it  it  it  it  k  k  it  k  k  k  if  it  k  k  k  k  k  k  k  k  it  it  k  it  it  k  k  k  k  k  k  k  k 

CALL  send_real_32bit (mach) 

CALL  send_real_32bit (qa) 

CALL  send_real_32bit (vrwm(l) ) 

CALL  send_real_32bit (vrwm(2) ) 

CALL  send_real_32bit (vrwm(3) ) 

CALL  mmk(0.0d0,  1,  O.OdO,  2,  omegae*t,  3,  cer) 

CALL  mmlxy(cer,  cie,  cir) 

CALL  trans (cir,  cri) 

c - get  parameters  from  main  partition  1  thread - c 

CALL  receive_real_64bit (xyz (1) ) 

CALL  receive_real_64bit (xyz (2) ) 

CALL  receive_real_64bit (xyz (3) ) 

CALL  receive_real_64bit (xyzd(l) ) 

CALL  receive_real_64bit (xyzd(2) ) 

CALL  receive_real_64bit (xyzd(3) ) 

CALL  receive  real  32bit (cim(l) ) 


46 


Appendix  A 

Exosim  vl.O  Boost  Phase 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


A^LMainling  (FORTRAN) 

A.l.l  Aeroca.for 

PROGRAM  main 
IMPLICIT  REAL{a-h,  0-2) 
REAL  calm(205),  ca2m(203) 
REAL  mach,  alfat,  ca 
♦include  "include/constant .dat" 
♦include  "include/calm.daf ' 
♦include  "include/ca2m.dat" 

DATA  icaml/0/,  icaal/0/ 
DATA  icam2/0/,  icaa2/0/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 


10  CONTINUE 

CALL  receive_iiet_32  (mach) 
CALL  receive  net  32 (alfat) 


IF  (t  .GT.  tStgl)  THEN 
c  second  stage 


CALL  tlu2ei (mach, 
ELSE 

c  first  stage 

alfat. 

ca2m. 

icam2 , 

icaa2. 

ca) 

CALL  tlu2ei (mach, 
ENDIF 

alfat. 

calm. 

icaml. 

icaal. 

ca) 

CALL  send_net_32 (ca) 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 


END 
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A.1.2  Aerocn.for 

PROGRAM,  main 
IMPLICIT  REAL(a-h,  0-z) 
REAL  cnal(205),  cna2(205) 
REAL  mach,  alfat,  cn 
finclude  ''include/constant  .dat" 
#include  "include/cnal .dat" 
#include  "include/cna2 .dat" 

DATA  icnml/0/,  icnal/0/ 
DATA  icnm2/0/,  icna2/0/ 

c  initialize  time 
tstep  =  0.0 
t  *•  tstep  *  delt 


10  CONTINUE 

CALL  receive_ret.l_32bit  (mach) 
CALL  receive  real  32bit (alfat) 


IF  (t  .GT.  tstgl)  THEN 
c  second  stage 


CALL  tlu2ei(mach, 
ELSE 

first  stage 

alfat. 

cna2. 

icnm2. 

icna2. 

cn) 

CALL  tlu2ei (mach, 
END  IF 

alfat. 

cnal, 

icnml. 

icnal. 

cn) 

CALL  send_real_32bit (cn) 

c  increment  time 

tstep  =  tstep  +1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.1.3  Aeroxcp.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  XCpll (205) ,  xcpl2(205) 
REAL  mach,  alfat,  xcp 
■finclude  "include/constant .dat" 
#include  "include/xcpll .dat" 
#include  "include/xcpl2 .dat" 

DATA  ixcpml/0/,  ixcpal/0/ 
DATA  ixcpm2/0/,  ixcpa2/0/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 


1C  CONTINUE 

CALL  receive_real_32bit (mach) 

CALL  receive_real_32bit (alfat) 

IF  (t  .GT.  tstgl)  THEN 
c  second  stage 

CALL  tlu2ei (roach,  alfat,  xcpl2,  ixcpm2,  ixcpa2,  xcp) 
ELSE 

c  first  stage 

CALL  tlu2ei(mach,  alfat,  xcpll,  ixcpml,  ixcpal,  xcp) 
END  IF 

xcp  “  -  xcp/12,.0 

CALL  send_real_32bit (xcp) 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.1.4  Attlm.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 
REAL  attltt(5),  attlmt{5) 
REAL  attlm 

#inclucie  "include/constant  .dat" 
tinclude  "include/attltt .dat" 
#include  "include/atclmt .dat" 
DATA  itable/0/ 

c  initialize  time 
tstep  =  0.0 
t  *  tstep  *  delt 


10  CONTINUE 

CALL  table (attltt,  attlmt,  t,  attlm,  5,  itable) 

CALL  send_real_32bit (attlm) 

c  increment  time 

tstep  -  tstep  +  1.0 
t  -  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 


38 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


A.  1.5  Bauto.for 

PROGRAM  main 

c - . - 

c  subroutine  bauto (t, thter,psier, sq, sr,  ii, cgest, vrwm, alt , cmmd, 

c  .  dlpc,dlyc,mdltfr,malpha) 

c - 

c  function  : 

c 

c  inputs  : 

c  outputs  : 

c - 

IMPLICIT  REAL(a-h,  0-z) 

REAL  cgest (3),  ii(3),  alt,  cne,  xcpe 
REAL  estmch,  alfate 
REAL  cmmd (2) 

REAL  ktht,  kpsi,  kthtd 

REAL  kpsid,  timtel(26),  timte2(29) 

REAL  thrtel(26) ,  thrte2(29),  altte{59) 

REAL  rhote (59),  vrwm ( 3 ) 

REAL  Id,  kne,  kme 

REAL  Ifracs,  frcl0C(3,  4) 

REAL  kthtkl,  kthtk2 
REAL  krtfrc,  kthfrc 
REAL  kthfml,  kthfm2,  vsndte(59) 

REAL  presste{59),  mchlim,  wmfrtt(4) 

REAL  wmfrct (4) 

REAL  dlpc,  dlyc,  sq,  sr,  mdltfr,  malpha 
#include  "include/constant .dat" 
linclude  "include/frcloc.aat" 

#include  "include/altte .dat" 

#include  "i 'clude/rhote.dat" 

#include  "iuclude/presste.dat" 
finclude  "include/vsndte .dat" 

#include  "include/timtel .dat" 
tinclude  "include/timte2 .dat" 

#include  "include/thrtel .dat" 
finclude  "include/thrte2 .dat" 

DATA  tapu/0.0/,  dtapu/0 . 005/,  tapustep/5 . 0/ 

DATA  mchlim/4.0/,  kthtkl,  kthtk2/.6,  1.5/ 

DATA  tign/0.01/,  tst2on/22 . 995/,  tfrcs/23.0/,  tmode2/23 . 01/ 

DATA  wmtvc/25.0/,  zettvc/0 . 85/,  wmfrtt/0.0,  9.5,  39.95,  100./ 

DATA  wmfrct/62.83,  62.83,  42.,  42./,  zetf rc/0 . 85/,  delon/0.045/ 
DATA  bcklmt/0.15/,  delthg/0 . 045/,  thjet/370./,  sjet/1.3273/ 

DATA  sref 1/1. 968953/,  sref2/l . 968953/,  aexite/ . 305/,  aexit2/0.99/ 
DATA  xnoze/-12 . 5583/,  xnoz2/-7 . 391C7/,  djet/1.3/,  xjet/-2.71/ 

DATA  ialte/0/,  ithle/0/,  ith2e/0/,  iwmfrc/0/ 

DATA  dtr/0. 017453292519943296/,  slglbm/32 . 174048/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 

cmmd ( 1 )  =  0.0 
cmmd ( 2 )  =  0.0 
dlpc  =  0.0 
dlyc  =0.0 
mdltfr  =  0.0 
malpha  -  0.0 
sq  =  0.0 
sr  =  0.0 


provides  control  of  the  missile  about  three 
axes  throughout  the  boost  phase  of  flight 
t, thter,psier, sq, sr,  ii, cgest, vrwm, alt 
cmmd, dlpc, dlyc, mdltfr, malpha 
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10  CONTINUE 

CALL  send_real_32bit (cmmd(l) ; 

CALL  send_real_32bit (cmmd<2) ) 

CALL  send_real_32bit (dlpc) 

CALL  send_real_32bit (dlyc) 

CALL  send_real_32bit (sq) 

CALL  send_real_32bit (sr) 

CALL  send_real_32bit (mdltfr) 

CALL  send_real_32bit (malpha) 

CALL  receive_real_32bit (cgest (1) ) 

CALL  receive_real_32bit (cgest (2) ) 

CALL  receive_real_32bit (cgest (3) ) 

CALL  receive_real_32bit  Ui (2) ) 

CALL  receive_real_32bit Ult) 

CALL  receive_real_32bit  (vrwmd) ) 

CALL  receive_real_32bit (vrwm{2) ) 

CALL  receive_real_32bit  (vrwin(3) ) 

IP  (tstep  .GE.  tapu)  THEN 
tapu  «  tapu  +  tapustep 

IF  (t  .LT.  tstg2)  THEN 

IF  (abs(t  -  tstgl)  .LE,  dteps)  THEN 
aexite  -  aexit2 
xnoze  =  xnoz2 
ENDIF 

esLalt  =  alt 

CALL  table (altte,  rhote,  estalt,  estrho,  59,  ialte) 
estrho  •  estrho*! . Oe-6/slglbm 

CALL  table (altte,  presste,  estalt,  estpre,  59,  ialte) 

CALL  table (altte,  vsndte,  estalt,  estvsd,  59,  ialte) 
estve’  “  sqrt  (vrwmd)  **2  +  vrwm(2)**2  +  vrwm(3)**2) 
estmch  =  estvel/estvsd 
estqa  -  estrho*estvel**2/2.0 
IF  (t  .GT.  tstgl)  THEN 
srefe  =  sref2 
to  ••  t  -  tst2on 

CALL  table (timte2,  thrte2,  tO,  thrve,  29,  ith2e) 

ELSE 

to  =  t  tign 
srefe  =  srefl 

CALL  table (timtel,  thrtel,  tO,  thrve,  26,  ithle) 

ENDIF 

thre  =  thrve  -  aexite*estpre 
IF  (thre  .LT.  0.0)  thre  =0.0 
IF  (estvel  .GT.  0.0)  THEN 

alfato  =  sparctan (sqrt (vrwm(2) **2  +  vrwm(3)**2),  abs(vrwm 
&  (l)))/dtr 

ELSE 

alfate  =  0.0 
ENDIF 

CALL  send_real_32bit (estmch) 

CALL  send_real_32bit (alfate) 
if  (  t. It. tstgl  )  then 

call  tlu2ei (estmch, 4 . OdO, cnale, icnmle, icnale, cne) 
call  tlu2ei (estmch, alfate, xcplle, icpmle, icpale,  xcpe) 
else 

call  tlu2ei (estmch, 4 .0d0,cna2e, icnm2e, icna2e, cne) 
call  tlu2ei (estmch, alfate, xcpl2e, icpm2e, icpa2e, xcpe) 
end  if 

CALL  receive_real_32bit (cne) 

CALL  receive_real_32bit (xcpe) 
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c  conversion  from  inches  to  feet 
xcpe  =  -  xcpe/12.0 

c  calculate  cnalfa  (per  radian) 
cnalp  =  cne/ (4 .0*dtr) 
xcpcg  =  xcpe  -  cgest(l) 

IF  (thre  .GE.  1000.0  .AND,  ii(2)  .GT.  l.Oe-6)  malpha  =  abs 
&  (cnalp*xcpcg*srefe*estqa/ii (2) ) 

CALL  receive_real_32bit (psier) 

CALL  receive_real_32bit (thter) 

CALL  receive_real_32bit (sq) 

CALL  receive_real_32bit (sr) 

c  tvc  autopilot 

IF  (t  .LT,  tmode2)  THEN 

IF  (thre  .GE.  1000.0  .AND.  ii(2)  .GT.  l.Oe-6)  THEN 
xdel  =  cgest(l)  -  xnoze 

ktht  *  (ii (2) *wmtvc**2  +  cnalp*srefe*estqa*xcpcg) / (thre 
&  *xdel) 

kpsi  =  (ii (2) *wmtvc**2  +  cnalp*srefe*estqa*xcpcg) / (thre 
&  *xdel) 

kthtd  =  2 . 0*zettvc*wmtvc*ii (2) / (thre*xdel) 
kpsid  =  2.0*zettvc*wmtvc*ii (2) / (thre*xdel) 

ELSE 

ktht  =4,0 
kpsi  =4.0 
kthtd  -  4.0 

kpsid  =  4.0 

ENDIF 

cmmd(l)  =  thter *ktht  -  sq*kthtd 

cmmd(2)  =  psier*kpsi  -  sr^kpsid 

totcmd  =  sqrt  (cmmd(l)  **2  +  cnund(2)**2) 

IF  (totcmd  .GT,  bcklmt)  THEN 
cmmd(l)  =  cmmd(l) *bcklmt/totcmd 
cmmd(2)  =  cmmd(2) *bcklmt/totcmd 
ENDIF 
ELSE 

cmmd(l)  =  0.0 
cmmd ( 2 )  =0.0 
ENDIF 

c  forward  reaction  control  system  autopilot 
IF  (t  .GE.  tfrcs)  THEN 

IF  (thre  ,GE.  1000.0  .AND.  ii(2)  .GT.  l.Oe-6)  THEN 
Id  =  (xjet  -  xnoze) /djet 
ct  =  thjet/ (estqa*s jet) 

IF  (estmch  .LE.  mchlim)  THEN 

kne  =  0.6118  +  (0.1358* (1.  -  0 . 485*sqrt (Id) ) /sqrt (cti ' 
&  +  0.0946*estmch  +  0.0043l7/ld 

ELSE 

kne  =  1.0  +  expd.l  -  0 .2116*  (log  (ct)  +  8.5)**1.4) 
ENDIF 

kme  =  0.5582  -  0 . 1884/sqrt (ct)  -  1.9659/2d 
Ifracs  =  frclocd,  1)  -  cgestd) 

mdltfr  =  (  -  kme*th jet*djet  +  kne*thjet*lfracs) /ii (2) 
CALL  table (wmfrtt,  wmfrct,  t  -  tmode2,  wmfrc,  4, 

&  iwmfrc) 

krtfrc  =  2 . 0*zetfrc*wmfrc/ (wmfrc**2  +  malpha) 
kthfrc  =  2 .0*delon/ (mdltfr *krtfrc*dtapu) 
kthfml  =  delon*malpha/mdltfr 
kLhfm2  =  delon/delthg 

IF  (kthfrc  .LT.  kthfml)  kthfrc  =  kthfml 
IF  (kthfrc  .LT.  kthfm2)  kthfrc  =  kthfm2 
ktht  =  kthfrc*kthtkl 
kthtd  =  ktht*krtfrc*kthtk2 
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kpsi  =  ktht 
kpsid  =  kthtd 
ELSE 

malpha  =  544.18 
mdltfr  =  6.0437 
ktht  =10.0 
kthtd  =25.0 
kpsi  =  10.0 
kpsid  =25.0 
ENDIF 

dlpc  =  thter*ktht  -  sq*kthtd 
dlyc  =  psier*kpsi  -  sr*kpsid 
ENDIF 
ELSE 

CALL  send_real_32bit (estmch) 
CALL  send_real_32bit (alfate) 
CALL  receive_real_32bit (cne) 
CALL  receive_real_32bit (xcpe) 
CALL  receive_real_32bit (psier) 
CALL  receive_real_32bit (thter) 
CALL  receive_real_32bit (sq) 
CALL  receive_real_32bit <sr) 
ENDIF 
ELSE 

CALL  send_real_32bit (estmch) 

CALL  send_real_32bit (alfate) 

CALL  receive_real_32bit (cne) 

CALL  receive_real_32bit (xcpe) 
CALL  receive_real_32bit (psier) 
CALL  receive_real_32bit (thter) 
CALL  receive_real_32bit (sq) 

CALL  receive~real~32bit (sr) 

ENDIF 

c  increment  time 

tstep  =  tstep  +1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.1.6  Boostla.for 

PROGRAM  main 

IMPLICIT  DOUBLEPRECISION (a-h,  O-z) 

REAL  gr(3) 

DOUBLE  PRECISION  latlp,  longlp 
DOUBLE  PRECISION  xyz(3) 

DOUBLE  PRECISION  xyzd(3),  xyzcid{3),  xyze{3) 

DOUBLE  PRECISION  xyzed(C),  xyzedd(3),  cei(9) 

REAL  mdotf,  msstg2,  mass,  massold,  massO 
REAL  frcx,  frcy,  frcz,  alt 
REAL  mdot,  fxt,  fyt,  fzt 
REAL  ud,  vd,  wd,  wkv,  wkvO,  wdoLkv 
REAL  cim(9),  mdott,  spt 
REAL  tmp_xyz ( 3 ) 

#include  "include/constant .dat" 

DATA  rade/20898908.0/,  msstg2/19. 457/ 

DATA  dtr/0. 017453292519943296/,  slglbm/32 . 174048/ 

DATA  massO/43.939/,  wkvO/97.1/ 

DATA  latlp/0.0/,  longlp/0.0/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 

DO  10  i  =  1,  3 
xyze(i)  =  0.0 
xyzed(i)  =  0.0 
xyzedd(i)  =  0.0 
10  CONTINUE 

xyze(l)  =  rade 

alt  =  dsqrt (xyze (1) **2  +  xyze{2)**2  +  xyze(3)**2)  -  rade 

c - c 

c -  missile  state  initialization  module  - c 

c - c 

c  initialize  states  and  state  derivatives 
mass  =  raassO 
wkv  =  wkvO 

CALL  mmk(-90.0*dtr,  1,  latlp*dtr,  2,  longlp*dtr,  3,  cei) 

CALL  vecrot (xyzed,  cei,  xyzd) 

CALL  vecrot (xyze,  cei,  xyz) 
mdot  =  0.0 
wdotkv  =  0.0 

CALL  vecrot (xyzedd,  cei,  xyzdd) 
spt  =  t 

CALL  spintegi (mass,  mdot,  spt,  1) 

CALL  spintegi (wkv,  wdotkv,  spt,  5) 

CALL  integi (xyzd(l) ,  xyzdd(l),  t,  6) 

CALL  integi (xyzd (2) ,  xyzdd(2),  t,  7) 

CALL  integi (xyzd (3) ,  xyzdd(3),  t,  8) 

CALL  integi  (xyz  (1) ,  xyzdd),  t,  9) 

CALL  integi (xyz (2) ,  xyzd(2),  t,  10) 

CALL  integi (xyz (3) ,  xyzd (3),  t,  11) 

c - 

c  initialize  processor  inputs  if  not  already  initialized 
c  pi 

fxt  =  0.0 
fyt  =  0.0 
fzt  =  0.0 
mdott  =  0.0 
frcx  =0.0 
frcy  =  0.0 
frcz  =0.0 
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mdotf  =  0.0 

c  p2 
c  p3 

ud  =  0.0 
vd  =  0.0 
wd  =  0.0 

c  p4 

DO  20  i  =  1,  3 
gr(i)  =  0.0 
20  CONTINUE 
C  p5 

c  initialization  routine 

mass  =  mass  +  delt*mdot 

c - c 

c - main  execution  loop -  - - c 

c -  - c 

30  CONTINUE 

Q********************************************************* ************** 

c  * 

c  partition  1  * 

c  * 

Qit  it  it  if  if  it  it  it  it  ic  it  it  ic  it  it  it  it  it  it  it  it  i(  if  it  if  -k  "k  -k  it  -k  ie  -k  ic  -k  it  it  -k  it  it  it  it  -k  'k  -k  -k  it  it  it  it  idt  -k  it  it  it  it  -k  it  -k  it  if  it  it  -k  ^  it  ^  "k  icit 

c - missile  state  update  module - c 

c  temporarily  extrapolate  missile  states  from  last  integration 
c  step  (  note  ;  the  extrapolated  states  are  overwritten  when 
c  the  true  integration  is  performed  ) 

c - send  parameters  to  partitions  3,  4,  and  5 - c 

CALL  send_real_32bit (ud) 

CALL  send_real_32bit (vd) 

CALL  send_real_32bit (wd) 

CALL  send_real_32bit (gr (1) ) 

CALL  send_real_32bit (gr (2) ) 

CALL  send_real_32bit (gr (3) ) 

CALL  send_real_32bit Ult) 

c - send  mass  to  masspr  subroutine  table  loo)cup  processors - c 

CALL  send_real_32bit (mass) 
xyzd(l)  =  xyzd(l)  +  delt*xyzdd(l) 
xyzd(2)  =  xyzd(2)  +  delt*xyzdd(2) 
xyzd(3)  =  xyzd(3)  +  delt*xyzdd(3) 
xyz(l)  =  xyz(l)  +  delt*xyzd(l) 
xyz(2)  =  xyz(2)  +  delt*xyzd(2) 
xyz(3)  =  xyz(3)  +  delt*xyzd(3) 
c  calculate  current  missile  altitude 

alt  =  dsqrt (xyz (1) **2  +  xyz(2)**2  +  xyz(3)**2)  -  rade 

c -  send  altitude  to  atmos  subroutine  table  loolcup  processors  -c 

CALL  send_real_32bit (alt) 

c -  send  parameters  to  thread  containing  winds  subroutine  - c 

CALL  Sfend_real_64bit (xyz (1) ) 

CALL  send_real_64bit (xyz (2) ) 

CALL  send_real_64bit (xyz (3) ) 

CALL  send_real_64bit (xyzd(l) ) 

CALL  send_real_64bit (xyzd(2) ) 

CALL  send_real_64bit (xyzd(3) ) 

CALL  receive_real_32bit (cim(l) ) 

CALL  receive_real_32bit (cim(2) ) 

CALL  receive_real_32bit (cim(3) ) 

CALL  receive_real_32bit (cira(4) ) 

CALL  receive_real_32bit (cim(5) ) 

CALL  receive_real_32bit (cim(6) ) 

CALL  receive_real_32bit (cim(7) ) 

CALL  receive_real_32bit (cim(8) ) 

CALL  receive_real_32bit (cim(9) ) 

c -  receive  parameters  from  partition  #2  - c 

CALL  receive  real  32bit(fxt) 
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CALL  receive_real_32bit (fyt) 

CALL  receive_real_32bit (fzt) 

CALL  receive_real_32bit (frcx) 

CALL  receive_real_32bit (frcy) 

CALL  receive_real_32bit (frcz) 

CALL  receive_real_32bit (mdott) 

CALL  receive_real_32bit (mdotf ) 
wkv  =  wkv  +  delt*wdotkv 
mdotkv  =  -  mdotf *slglbm 

mdot  =  -  mdott  -  mdotf 

c  save  mass  value  for  use  in  missil  subroutine 
mas  sold  =  mass 


spt  =  t 

c  trapezoidal  integration  for  simplicity 
IF  (dabs(t  -  tstgl)  .LE.  dteps)  THEN 
c  first  stage  separation 
mass  =  msstg2 

CALL  spintegi (mass,  O.OeO,  spt,  1) 
ELSEIE'  (dabs(t  -  tstg2)  .LE.  dteps)  THEN 
c  second  stage  separation 
mass  =  wkv/slglbm 
CALL  spintegi (mass,  O.OeO,  spt,  1) 

ELSE 

CALL  spinteg (mass,  mdot,  spt,  1) 

ENDIF 

wkv  =  amaxKwkv,  O.eO) 

CALL  spinteg (wkv,  wdotkv,  spt,  5) 
mass  =  mass  +  delt*mdot 


c - vehicle  states  module - c 

CALL  missil (t,  massold,  fxt,  frcx,  fyt,  frcy,  fzt,  frcz,  xyz, 

&  xyzd,  ud,  vd,  wd,  gr,  cim,  xyzdd) 


c - - - - - - - - - c 

c  missile  state  integration  module  c 

- - - 


CALL  integ(xyzd(l) ,  xyzdd (1),  t,  6) 

CALL  integ (xyzd(2) ,  xyzdd (2),  t,  7) 

CALL  integ(xyzd(3) ,  xyzdd(3),  t,  8) 

CALL  integ (xyz (1) ,  xyzd(l),  t,  9) 

CALL  integ (xyz (2) ,  xyzd (2),  t,  10) 

CALL  integ (xyz (3) ,  xyzd(3),  t,  11) 
c  calculate  current  missile  altitude 

alt  =  dsqrt (xyz (1) **2  +  xyz(2)**2  +  xyz(3)**2)  -  rade 
tmp_xyz ( 1 )  =  xyz ( 1 ) 
tmp_xyz(2)  =  xyz (2) 
tmp_xyz(3)  =  xyz (3) 

CALL  send_real_32bit (tmp_xyz (1) ) 

CALL  send_real_32bit (tmp_xyz (2) ) 

CALL  send_real_32bit (tmp_xyz (3) ) 

CALL  send_real_32bit (alt) 

d;**************************************************************.********* 

C  * 

c  end  of  partition  1  * 

c  * 

Q*********************************************************************** 


c  increment  rime 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  ,.LT.  tfinal)  GOTO  30 

END 


45 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


A.1.7  Boost2al.for 

PROGRAM  main 

IMPLICIT  DOUBLEPRECISION {a-h,  o-z) 

DOUBLE  PRECISION  mvrwm,  cir(9) 

DOUBLE  PRECISION  xyzr(3),  xyz(3),  xyzd{3),  xyze(3) 
DOUBLE  PRECISION  cer(9),  cri(9),  cie{9) 

DOUBLE  PRECISION  cei(9),  latlp,  longlp 
DOUBLE  PRECISION  vrwi(3),  cwr(9) 

DOUBLE  PRECISION  vrwind(3),  viwind(3),  vwwind(3) 
REAL  fxa,  fya,  fza 

REAL  mach,  al5at,  ca,  cn,  vrwm(3),  qa 
REAL  lat,  long,  rhod2,  vsnd,  cim{9) 

REAL  shear,  swdir,  cwdir,  vwind 
#include  ''include/constant  .dat" 

DATA  omegae/0.0/,  dtr/0. 017453292519943296/ 

DATA  sref 1/1. 968953/,  sref2/l . 968953/ 

DATA  latlp,  longlp,  tmpl/3*0.0/ 

c  initialize  time 
tstep  =  0.0 
t  “  tstep  *  delt 


c - c 

c - missile  state  initialization  module - c 

c - c 


c  initialize  states  and  state  derivatives 

CALL  mmk(-90.0*dtr,  1,  latlp*dtr,  2,  longlp*dtr,  3,  cei) 
CALL  trans(cei,  cie) 

c - 

c  initialize  processor  inputs  if  not  already  initialized 
c  p2 

qa  0.0 
mach  =  0.0 

c  p5 

DO  10  i  =  1,  3 
vrwm(i)  =  0.0 
10  CONTINUE 


c - c 

c - main  execution  loop - c 

C - c 

20  CONTINUE 


C  * 

c  partition  1  * 

c  * 


CALL  send_real_32bit (mach) 

CALL  send_real_32bit (qa) 

CALL  send_real_32bit (vrwm(l) ) 

CALL  send_real_32bit (vrwm(2) ) 

CALL  send_real_32bit (vrwm(3) ) 

CALL  mm)c(0.0d0,  1,  O.OdO,  2,  omegae*t,  3,  cer) 

CALL  mmlxy(cer,  cie,  cir) 

CALL  trans(cir,  cri) 

c -  get  parameters  from  main  partition  1  thread  - c 

CALL  receive_real_64bit (xyz (1) ) 

CALL  receive_real_64bit (xyz (2) ) 

CALL  receive_real_64bit (xyz (3) ) 

CALL  receive_real_64bit  (xyzdd) ) 

CALL  receive_real_64bit (xyzd<2) ) 

CALL  receive__real_64bit  (xyzd  (3) ) 

CALL  receive"’real  32bit  (cim(l) ) 
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C*tLL  r€'ceive_real_32bit  (cim(2) ) 

CALL  receive_real_32bit (cim(3) ) 

CALL  receive_real_32bit {cim(4) ) 

CALL  receive_real_32bit  (ciin(5) ) 

CALL  receive_real_32bit (cim{6) ) 

CALL  receive_real_32bit (cim(7) ) 

CALL  receive_real_32bit (cim(8) ) 

CALL  receive_real_32bit (cim(9) ) 

xyze(l)  =  cie (1) *xyz (1)  +  cie (4) *xyz (2)  +  cie (7) *xyz (3) 

xyze(2)  =  cie (2) *xyz (1)  +  cie (5) *xyz (2)  +  cie (8) *xyz (3) 

xyze(3)  =  cie (3) *xyz (1)  +  cie (6) *xyz (2)  +  cie (9) *xyz  (3) 

CALL  vecrot (xyze,  cer,  xyzr) 
c  calculate  current  latitude  and  longitude 

lat  =  arctan(xyzr(3) ,  dsqrt (xyzr (1) **2  +  xyzr(2)**2)) 
long  =  arctan (xyzr (2) ,  xyzr(l)) 

c**********  start  of  winds  subroutine  *******************************c 
c  call  mmk  (0 .  OdO,  1, -lat,  2,  long,  3,  crw) 

c  call  trans (crw, cwr) 

a  -  cos (  -  lat) 
b  =  sin(  -  lat) 
c  -  cos  Uong) 
d  =  sin (long) 
cwr(l)  =  a*c 
cwr (2)  =  d 
cwr (3)  =  b*c 
cwr (4)  =  a*d 
cwr ( 5 )  =  c 
cwr (6)  =  b*d 
cwr (7)  =  b 
cwr (8)  =  0.0 
cwr (9)  =  a 

c - get  masspr  table  look  up  values  from  other  processors - c 

CALL  receive_real_32bit (vwind) 

CALL  receive_real_32bit (shear) 

CALL  receive_real_32bit (swdir) 

CALL  receive_real_32bit (cwdir) 
call  vmk  (shear, cwdir*vwind, swdir*vwind, vwwind) 
vwwind(l)  =  shear 
vwwind (2)  =  cwdir *vwind 
vwwind (3)  =  swdir *vwind 
CALL  vecrot (vwwind,  cwr,  vrwind) 

CALL  vecrot (vrwind,  cri,  viwind) 

CALL  vecsub(xyzd,  viwind,  vrwi) 
c  call  vecrot (vrwi, cim,vrwm) 

vrwm(l)  =  cim(l) *vrwi (1)  +  cim(4) *vrwi (2)  +  cim(7) *vrwi (3) 

vrwm(2)  =  cim(2) *vrwi (1)  +  cim(5) *vrwi (2)  +  cim(8) *vrwi (3) 

vrwm(3)  =  cim(3) *vrwi (1)  +  cim(6) *vrwi (2)  +  cim( 1) *vrwi (3) 

mvrwm  =  sqrt (vrwm(l) **2  +  vrwm(2)**2  +  vrwm(3)**2) 
c**********  end  of  winds  subroutine  **********************************c 

c -  calculate  parameters  from  aero  and  start  table  lookups  -c 

CALL  receive_real_32bit (vsnd) 
mach  =  mvrwm/vsnd 

tmpl  =  sqrt (vrwm(2) **2  +  vrwm(3)**2) 
tmp2  =  abs(vrwm(l)) 
alfat  =  arctan (tmpl,  tmp2)/dtr 
CALL  send_real_32bit (mach) 

CALL  send_real_32bit Ulfat) 

CALL  receive_real_32bit (rhod2) 
qa  =  (mvrwm**2) *rhod2 

c - perform  part  of  aero  subroutine - c 

IF  (mvrwm  .LE.  0.0  .OR.  t  .GE.  tstg2)  THEN 
fxa  =  O.OeO 
fya  =  O.OeO 
fza  =  O.OeO 
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CALL  receive_real_32bit (ca) 

CALL  receive_real_32bit (cn) 

ELSE 

IF  (dabs(tnipl)  .GT.  l.Od-6)  THEN 
cphia  =  vrwm(3) /tmpl 
sphia  =  vrwm(2) /tmpl 
ELSE 

cphia  =  1 . OdO 
sphia  =  O.OdO 
ENDIF 

IF  (t  .GT.  tstgl)  THEN 
sur  =  sref2 
ELSE 

sur  =  srefl 
ENDIF 

qs  =  qa*sur 

CALL  receive_real_32bit (ca) 

CALL  receive_real_32bit (cn) 
fxa  =  qs*ca 
fya  =  -  qs*cn*sphia 

fza  =  -  qs*cn*cphia 

ENDIF 

CALL  send_real_32bit ( fxa ) 

CALL  send_real_32bit (fya) 

CALL  send_real_32blt (fza) 

it  .•  ir  "k  it  it  ic  "k  it  "k  it  it  ic  it  it  it  if  it  it  *  if  ic  it  ic  it  it  ic  "kit  it  ic  icic  "k  *  icit  it  it -kic  ie -k  *  it  icic -k  it  it  ic  -k  ic  -k  -k  -k  *  -k  if  -k  ■A  it -k  -k  "k  "k  -k  -k 

c  * 

c  end  of  partition  1  * 

c  * 

Qk  k  k  k  k  it  k  it  it  k  it  k  it  k  it  k  it  k  k  k  k  it  k  k  k  k  k  it  k  it  it  k  it  k  k  k  it  k  it  it  k  k  k  k  it  k  k  k  k  k  it  k  k  k  k  k  k  k  k  k  k  k  k  k  it  k  k  k  k  k  k 

c  increment  time 

tstep  =  tstep  +  1.0 
t  *  tstep  *  delt, 

IF  (t  LT.  tfinal)  GOTO  20 

END 
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A.1.8  Boost2a2.for 


PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  cim(9) 

REAL  quat\4),  quatd(4) 

REAL  cmi{9) ,  pqr (3) 

REAL  pd,  qd,  rd 
REAL  told 

#include  "include/constant .dat" 

DATA  dtr/0. 017453292519943296/ 

DATA  tmpl/0.0/,  quatm/1.0/ 

DATA  phiicd/0 .0/,  thticd/-35 . 0/,  psiicd/0.0/ 

c  initialize  time 
tstep  =0.0 
t  =  tstep  *  delt 


DO  10  i  =  1,  3 
pqr{i)  =0.0 
10  CONTINUE 

phi  =  phiicd*dtr 
tht  =  thticd*dtr 
psi  =  psiicd*dtr 

CALL  spmmk(phi,  1,  tht,  2,  psi,  3,  cim) 
CALL  sptrans(cim,  cmi) 


c - c 

Q - missile  state  initialization  module - c 

c - c 


c  initialize  states  and  state  derivatives 
CALL  bxi2fv(quatm,  cmi,  quat) 
pd  =  0.0 
qd  =  0.0 
rd  =  0.0 

CALL  fvdot(pqr,  tmpl,  quat,  quatd) 

CALL  spintegi (pqr (1) ,  pd,  t,  12) 

CALL  spintegi (pqr (2) ,  qd,  t,  13) 

CALL  spintegi (pqr (3)  ,  rd,  t,  14) 

CALL  spintegi (quat (1) ,  quatd (1),  t,  15) 
CALL  spintegi (quat (2) ,  quatd (2),  t,  16) 
CALL  spintegi (quat (3) ,  quatd(3),  t,  17) 
CALL  spintegi (quat (4) ,  quatd (4),  t,  18) 
p  =  pqr(l) 
q  =  pqr (2) 
r  =  pqr (3) 
itst  =  0 


c - - c 

c - main  execution  loop - c 

c - c 

20  CONTINUE 

c  * 

c  partition  1  * 

c  * 


CALL  send_real_32bit (cim(l) ) 
CALL  send_real_32bit (cim(2) ) 
CALL  send_real_32bit (cim{3) ) 
CALL  send_real_32bit  (cimU)  ) 
CALL  send_real_32bit (cim(5) ) 
CALL  send_real_32bit (cim(6) ) 
CALL  send_real_32bit (cim(7) ) 
CALL  send_real_32bit (cim (8) ) 
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CALL  send_real_32bit {cim(9) ) 

C  Added  for  graphics  program 

CALL  send_real_32bit (phi) 

CALL  send_real_32bit (tht) 

CALL  send_real_32bit (psi) 

CALL  receive_real_32bit (pd) 

CALL  receive_real_32bit (qd) 

CALL  receive_real_32bit (rd) 

IF  (itst  .EQ.  0)  THEN 
itst  =  1 
ELSE 

CALL  spinteg(p,  pd,  told,  12) 

CALL  spintegiq,  qd,  told,  13) 

CALL  spinteg(r,  rd,  told,  14) 

END  IF 

p  «  p  +  delt*pd 
q  "  q  +  delt*qd 
r  •  r  +  delt*rd 

quat(l)  =  quatd)  +  delt*quatd{l) 
quat(2)  -  quat(2)  +  delt*quatdi2) 
quat(3)  =  quat(3)  +  delt*quatd{3) 
quat(4)  =  quat(4)  +  delt*quatd(4) 

c - section  of  missil  subroutine  that  finds  phi,  tht,  and  psi - c 

call  vin)c  (p,  q,  r,pqr) 
tmp2  «  0.0 

CALL  fvdot (pqr,  tmp2,  quat,  quatd) 

CALL  fv2bxi{quat,  tmp2,  cmi) 

CALL  sptrans(cmi,  cim) 

phi  =  sparctan (cim(8) ,  cim(9)) 

tht  =  -  arcsin (cim(7) ) 

psi  »  sparctan (cim (4) ,  cim(l)) 


c - c 

c  missile  state  integration  module  c 

c - c 


CALL  spinteg(quat (1) ,  quatd(l),  t,  15) 

CALL  spinteg(quat (2) ,  quatd(2),  t,  16) 

CALL  spinteg(quat (3) ,  quatd(3),  t,  17) 

CALL  spinteg (quat (4) ,  quatd (4),  t,  18) 

c  * 

c  end  of  partition  1  * 

c  * 

told  =  t 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  20 

END 
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A.1.9  Boost2a3.for 

PROGRAM  main 

IMPLICIT  DOUBLEPRECISION (a-h,  o-z) 
c  $include(' :pfp: include/target. for') 

DOUBLE  PRECISION  mxa,  mya,  mza 
DOUBLE  PRECISION  xyzlch(3) 

DOUBLE  PRECISION  xyz(3),  gb(3) 

DOUBLE  PRECISION  uxyz(3),  mx,  my,  mz 
DOUBLE  PRECISION  gr{3),  mgr,  mxyz 
REAL  fxa,  fya,  fza 
REAL  cim{9),  cmi(9) 

REAL  ixx,  iyy,  izz,  mass,  cg(3),  xcp 
REAL  mrcx,  mrcy,  mrcz,  frcx,  frcy,  frcz 
REAL  fxt,  fyt,  fzt,  mxt,  myt,  mzt 
REAL  p,  q,  r,  pd,  qd,  rd 
REAL  spt,  pqr(3) 
tinclude  "include/constant .dat" 

DATA  rade/20898908.0/ 

DATA  nclear/0/,  imis/0/,  xlnch/3.0/ 
DATA  ginu/1.4052477el6/ 


c  initialize  time 
tstep  =0.0 
t  -  tstep  *  delt 


c 

c 

c 

c 


DO  10  i  =  1,  3 
pqr(i)  =  0.0 
10  CONTINUE 


missile  state  initialization  module 


initialize  states  and  state 
pd  =  0.0 
qd  =  0.0 
rd  =  0.0 
spt  =  t 

CALL  spintegi (pqr (1) ,  pd, 
CALL  spintegi (pqr (2) ,  qd, 
CALL  spintegi (pqr (3) ,  rd, 
p  =  pqr(l) 
q  =  pqr (2) 
r  =  pqr (3) 

DO  20  i  =  1,  3 
gr(i)  =  0.0 
20  CONTINUE 


derivatives 


spt,  12) 
spt,  13) 
spt,  14) 


c 


C - C 

c - main  execution  loop - c 

c - c 

30  CONTINUE 

Q'k 'k  * -k -k  -k -k  ic  ■k  * -k  if  "k  it  ick -k  it  -k  iticic  "k  ^  ic  it  "k  *  fc -k -k -k -k  ic -k  ic  •*:  ie  -k  if -k  i!  *  ic  if  it  i( -k -k  if  i: -k -k  it -k  "k  it  *  if -k  i:  itifk  it 


C  * 

c  partition  1  * 

c  * 

Q***************************:******************************************** 

c - send  parameters  to  partitions  3,  4,  and  5 - c 

CALL  send_real_32bit (p) 

CALL  sendreal  32bit (q) 

CALL  send_real_32bit (r) 

CALL  send_real_32bit (pd) 

CALL  send_real_32bit (qd) 

CALL  send_real_32bit (rd) 

CALL  receive  real  32bit(mass) 
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CALL  receive_real_64bit (xyz (1) ) 

CALL  receive_real_64bit (xyz (2) ) 

CALL  receive_real_64bit (xyz (3) ) 

CALL  receive_real_32bit  (cimd) ) 

CALL  receive_real_32bit (cim(2) ) 

CALL  receive_real_32bit (cim(3) ) 

CALL  receive_real_32bit (cim(4) ) 

CALL  receive_real_32bit (cim{5) ) 

CALL  receive_real_32bit (cim(6) ) 

CALL  receive_real_32bit (cim(7) ) 

CALL  receive_real_32bit {cim(8) ) 

CALL  receive_real_32bit (cim(9) ) 

c -  receive  parameters  from  partition  #2  - c 

CALL  receive_real_32bit (fxt) 

CALL  receive_real_32bit (fyt) 

CALL  receive_real_32bit (fzt) 

CALL  receive_real_32bit (mxt) 

CALL  receive_real_32bit (myt) 

CALL  receive_real_32bit (mzt) 

CALL  receive_real_32bit (frcx) 

CALL  receive_real_32bit (frcy) 

CALL  receive_real_32bit (frcz) 

CALL  receive_real_32bit (mrcx) 

CALL  receive_real_32bit (mrcy) 

CALL  receive_real_32bit (mrcz) 

c -  mass  properties  module  - c 

CALL  receive_real_32bit (eg (1) ) 

CALL  receive_real_32bit (eg (2) ) 

CALL  receive_real_32bit (eg (3) ) 

CALL  receive_real_32bit (ixx) 

CALL  receive_real_32bit (iyy) 

CALL  receive_real_32bit (izz) 
p  =  p  +  delt*pd 
q  -  q  +  delt*qd 
r  =  r  +  delt*rd 

vehicle  states  module - c 


IF  (imis  .EQ.  0)  THEN 
CALL  sptrans (cim,  cmi) 
xyzlch(l)  =  xlnch*cmi(l)  +  rade 
xyzlch(2)  =  xlnch*cmi(2) 
xyzlch(3)  =  xlnch*cmi(3) 
imis  =  1 
ENDIF 

CALL  magt(xyz,  mxyz,  uxyz) 

mgr  =  gmu/mxyz**2 

CALL  mvbys(-mgr,  uxyz,  gr) 

CALL  vecrot (gr,  cim,  gb) 

gb(l)  =  cim(l)*gr(l)  +  cim(4)*gr(2)  +  cim(7)*gr(3) 

gb(2)  =  cim(2)*gr(l)  +  cim(5)*grd)  +  cim(8)*gr(3) 

gb(3)  =  cim(3)*gr(l)  +  cim(6)*gr(2)  +  cim(9)*gr(3) 


section  of  aero  subroutine  to - c 

calculate  mxa,raya,  and  mza  from  fxa,fya,and  fza  — c 


CALL  receive_real_32bit (fxa) 

CALL  receive_real_32bit (fya) 

CALL  receive_real_32bit (fza) 

CALL  receive_real_32bit (xcp) 

mxa  =  fya*cg(3)  -  f2a*cg(2) 

mya  =  -  fxa*cg(3)  +  fza*  (eg (1)  -  xcp) 

mza  =  fxa*cg(2)  -  fya* (eg (1)  -  xcp) 

-  section  of  missil  subroutine  to  find 

-  pd,  qd,  and  rd 

fx  =  fxt  +  fxa  +  frcx 
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fy  =  fyt  +  fya  +  frcy 
fz  =  fzt  +  fza  +  frcz 
mx  =  mxa  +  inxt  +  mrcx 
my  =  mya  +  myt  +  mrcy 
mz  *  mza  +  mzt  +  mrcz 
IF  (nclear  .EQ.  1)  THEN 
pd  =  0.0 

qd  =  my/iyy  +  r*p*((izz  -  ixx) /iyy) 
rd  =  mz/izz  +  p*q*{(ixx  -  iyy)/izz) 

ELSEIF  (fx/mass  .LE.  dabs(gb(l)))  THEN 
pd  =  0.0 
qd  =  0.0 
rd  “  0.0 

ELSEIF  (xyz(l)  .LE.  xyzlch{l)  .AND.  xyz(2)  .LE.  xyzlch(2)  .AND. 
&  xyz(3)  .LE.  xyzlchO))  THEN 
pd  -  0.0 
qd  =  0.0 
rd  =  0.0 
ELSE 

nclear  =  1 

c  call  output_message (  %val (character_08bit) , 

c  .  '  missile  has  cleared  the  launcher'  ) 

c  call  output_nl 

pd  =  0.0 

qd  =  my/iyy  +  r*p*((izz  -  ixx) /iyy) 
rd  =  mz/izz  +  p*q*((ixx  -  iyy)/izz) 

ENDIF 


- - - 

c  missile  state  integration  module  c 

- - - 


spt  *=  t 

CALL  spintegtp,  pd,  spt,  12) 

CALL  spinteg(q,  qd,  spt,  13) 

CALL  spintegir,  rd,  spt,  14) 

Q*  *  *  *  it  *  *  *  *  *  *  *  *  it  *  *  *  *  *  *  *  *  *  *  it  *  *  *  *  *  *  *  *  *  *  *  1,  *  *  *  *  -k  *  i,  *  Hi,  i,  Hi,  *  *  i,  ici,  a  i,  1,  i,  1,  i,  i,  i,  i,  i,  i,  i,  Hi, 

C  * 

c  end  of  partition  1  * 

c  * 

Q* -k  *  * -k  *  * -k  *  is  * -k  i(  ie  it  it  it -k  ^  it  ic  if -k  ft  if -k  icit  *  it -kit -k  i(i(ie  it -k  ick -k  ic  fr  *  icit  ide  ic -k  ick  it -k  *cicit  ic* -k  it  it  ie  i<  *  it  it  iK  it 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  30 

END 
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A.1.10  Boost2b.for 

PROGRAM  mair 
IMPLICIT  REAL(a-h,  0-2) 

REAL  tmf(10,  4),  thf(10,  4) 

INTEGER  lenf{4) 

REAL  mrcx,  mrcy,  mrcz 
REAL  malpha,  pm(3)/  mdotf 
REAL  eg (3),  mach 
REAL  mdltfr 

#include  "include/constant .dat” 

DATA  tfrac/23001.0/,  dtfru/5 . 0/, tfrcs/23 . 001/ 


c  initialize  time 
ts*-ep  =  0.0 
t  “=  tstep  *  delt 


DO  20  i  «=  1,  10 
DO  10  j  -  1,  4 
tmf(i,  j)  =  0.0 
thf(i,  j)  =  0.0 
10  CONTINUE 
20  CONTINUE 

DO  30  i  -  1,  4 
lenf(i)  *  0 
30  CONTINUE 

c - 

c - missile  state  initialization  module - 

c  pi 

frex  =0.0 
frey  =0.0 
frez  =  0.0 
mrcx  «  0.0 
mrcy  =0.0 
mrcz  =  0.0 
mdotf  =  0.0 


c - c 

c - main  execution  loop - c 

c - c 

40  CONTINUE 


if  itif  it  if  it  it  -k  "k  -k  "k  -k -k  it -k -k -k  ifk -k  "k  ■k  -k  -k  -k  -k -k  ^  "k  if  it -k  it -k  -k -k -k -k -k -k -k  -k  -k  -k  it  -k  it  it  -k  -k  "k  -k  it  iK  it  i(  "k  if  "k  it -k  it  it  k  it  "k  it  it 

c  * 

c  partition  2  * 

c  * 

^k  it  it  it  it  it  it  k  it  k  k  if  k  k  k  k  k  k  k  k  k  k  it  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  k  it  it  k  k  k  k  k  k  k  k  k  k  k  k  k  k 

c - send  parameters  to  partition  #1 - c 

CALL  send_real_32bit (frex) 

CALL  send_real_32bit (frey) 

CALL  send_real_32bit (frez) 

CALL  send_real_32bit (mrcx) 

CALL  send_real_32bit (mrcy) 

CALL  send_real_32bit (mrcz) 

CALL  send_real_32bit (mdotf) 

c -  receive  parameters  from  partition  #1  - c 

CALL  receive_real_32bit (cg(l) ) 

CALL  receive_real_32bit (cg(2) ) 

CALL  receive_real_32bit (cg(3) ) 

c -  receive  parameters  from  partition  #1  - c 

CALL  receive_real_32bit (mach) 

CALL  receive_real_32bit (qa) 

c - receive  parameters  from  partition  #3,4,  and  5 - c 

CALL  receive_real_32bit (dlpc) 

CALL  receive_real_32bit (dlyc) 
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CALL  receive_real_32bit (sq) 

CALL  receive_real_32bit (sr) 

CALL  receive_real_32bit (mdltfr) 

CALL  receive_real_32bit (malpha) 

CALL  receive_real_32bit (pm(l) ) 

CALL  receive_real_32bit (pm<2) ) 

CALL  receive_real_32bit {pm(3) ) 

c - fracs  thruster  response  module - c 

IF  (t  .GE.  tfrcs  .AND.  t  .LT.  tstg2)  THEN 

CALL  £rcthr(t,  eg,  mtch,  qa,  tm£,  thf,  lenf,  frex,  frey,  frez, 

&  mrex,  mrcy,  mrez,  mdotf) 

c - fracs  logic  module - c 

IF  (tstep  .GE.  tfrac)  THEN 

CALL  fracs (t,  dlpc,  dlyc,  sq,  sr,  mdltfr,  malpha,  pm,  tmf, 

&  thf,  lenf) 

tfrac  =  tfrac  +  dtfru 
END  IF 
ELSE 

frex  =  0. 
frey  =  0. 
frez  =  0. 
mrex  =  0 . 
mrcy  =  0. 
mrez  =  0. 
mdotf  =  0. 

ENDIF 

C  * 

c  end  of  partition  2  * 

c  * 

Q*********************************************************************** 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  40 


END 
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A.1.11  Boost2bl.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  mxt,  myt,  mzt,  mdott 
REAL  cmmd(2) 

REAL  eg (3),  press 
tinclude  "include/constant .dat" 
DATA  tinhib/.35/ 

DATA  pmax/0. 13963/ 

DATA  dlpic/0.0/,  dlyic/0.0/ 

c  initialize  time 
tstep  =0.0 
t  =  tstep  *  delt 


c - c 

c - missile  state  initialization  module - c 

c - c 


c  initialize  states  and  state  derivatives 
dip  =  dlpic 
dly  =  dlyic 
dlpd  =0.0 
dlyd  =0.0 

CALL  spintegi (dip,  dlpd,  t,  19) 

CALL  spintegi (dly,  dlyd,  t,  20) 

c - 

c  initialize  processor  inputs  if  not  already  initialized 
c  pi 

fxt  =  0.0 
fyt  =  0.0 
fzt  =0.0 
mxt  =  0.0 
myt  =0.0 
mzt  =  0.0 
mdott  =  0.0 


c - c 

c - main  execution  loop - c 

10  CONTINUE 


Q**********************.  ★★★★★*★★★★★*★•*******★*★*★*****★*★★**★★★******)*:** 

c  * 

c  partition  2  * 

c  * 

c - send  parameters  to  partition  #1 - c 

CALL  send_real_32bit (fxt) 

CALL  send_real_32bit (fyt) 

CALL  send_real_32bit (fzt) 

CALL  send_real_ 32bit (mxt) 

CALL  send_real[^32bit  (myt) 

CALL  send_real_32bit (mzt) 

CALL  send_real_32bit (mdott) 

c - receive  parameters  from  parti*'ion  #1  - c 

CALL  receive_real_32bit (eg (1) ) 

CALL  receive_real_32bit (eg (2) ) 

CALL  receive_real_32bit (eg (3) ) 

c -  receive  parameters  from  partition  #1  - c 

CALL  receive_real_32bit (press) 

c - receive  parameters  from  partition  #3,4,  and  5 - c 

CALL  receive_real_32bit (cmmd(l) ) 

CALL  receive_real_32bit (cmmd(2) ) 

IF  (t  .LE.  tstgl)  THEN 
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dip  =  dip  +  delt*dlpd 
dly  =  dly  +  delt*dlyd 
totdel  =  sqrt{dlp**2  +  dly**2) 

IF  (totdel  .GT.  pmax)  THEN 
dip  =  dlp*pmax/totdel 
dly  =  dly*pmax/totdel 
ENDIF 
ENDIF 

c - boosters  module - c 

CALL  bthrst(t,  eg,  press,  dip,  dly,  fxt,  fyt,  fzt,  mxt,  myt,  mzt, 

&  mdott) 

c -  nozzle  control  unit  module  - c 

IF  (t  .LE.  tstgl)  THEN 
IF  (t  .GT.  tinhib)  THEN 

CALL  ncu(dlp,  dly,  emmd,  dlpd,  dlyd) 

ELSE 

dlpd  =0.0 
dlyd  =0.0 
ENDIF 

CALL  spinteg(dlp,  dlpd,  t,  19) 

CALL  spinteg(dly,  dlyd,  t,  20) 
totdel  =  sqrt(dlp**2  +  dly**2) 

IF  (totdel  .GT.  pmax)  THEN 
dip  =  dlp*pmax/totdel 
dly  =  dly*pmax/totdel 
ENDIF 
ELSE 

dip  =  0.0 
dly  =0.0 
ENDIF 

it  *  if  it  if  -k  if  *  it  it  ^  *  -k  it  -k  ■k  *  M  "k  -k  it  -k  "k  *  -k  -k  it  it  it  *(  ■*(  ic  it  ic  f(  iK  ic  ic  ie  *  it  it  •ki'.  ic-k  ic  it  *  -k  *  -k  ic  it  it  if  ■*(*  it  it  -k  -k  *  ic 

c  * 

c  end  of  partition  2  * 

c  * 

Q*^*****************************************************if*************** 


c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.  1.12  Boost2c.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  us (3),  ac(3),  vw(3) ,  pg<3) 

REAL  ti2m(9) ,  at (3) 

REAL  mvs,  mvr,  uvs(3),  gr(3) 

REAL  pqr{3) 

REAL  usd (3),  pgd(3),  vwd(3) 

REAL  mvrdot 

REAL  pm(3),  fq,  sr,  psier,  thter,  attlm 
REAjb  delphi,  deltht,  delpsi,  delu,  delv,  delw 
#include  "include/constant .dat" 

DATA  tst2on/22.995/ 

DATA  dtbgu/5.0/,  epsl/2 .5e-04/ 

DATA  dtr/0. 017453292519943296/ 

DATA  thticd/-35 . 0/,  psiicd/0.0/ 

DATA  vpl/13770.0/,  us0d/-22.0/ 

c  initialize  time 


tstep  =  0.0 
t  =  tstep  *  delt 

DO  10  i  =  1,  3 
pqr(i)  =0.0 
usd(i)  =  0.0 
pgdU)  =  0.0 
vwd(i)  =  0.0 
vw(i)  =  0.0 
10  CONTINUE 
mvrdot  =  0.0 


stht  *  thticd*dtr 
spsi  “  psiicd*dtr 
sq  =  pqr(2) 
sr  =  pqr(3) 

usd)  =  cos  (spsi)  *cos  {us0d*dtr) 
us  (2)  =  sin (spsi) *cos (us0d*dtr) 
us  (3)  =  -  sin (us0d*dtr) 

pg(l)  =  cos (spsi) *cos (stht) 
pg(2)  =  sin(spsi) *cos (stht) 
pg(3)  =  -  sin(stht) 


c - missile  state  initialization  module - 


c  initialize  processor  inputs  if  not  already  initialized 
DO  20  i  =  1,  3 
pm(i)  =  0.0 
20  CONTINUE 
delu  =0.0 
delv  =  0.0 
delw  =  0.0 
DO  30  i  =  1,  3 
at (i)  =  0.0 
30  CONTINUE 

DO  40  i  =  1,  9 
ti2m(i)  =  0.0 
40  CONTINUE 
mvr  =  vpl 

c  initialization  routine 
tgpu  =  0.0 
tlgpu  =  0.0 


main  execution  loop 
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c - c 

50  CONTINUE 

c - send  parameters  to  partition  #2 - c 

CALL  send_real_32bit (at (1) ) 

CALL  send_real_32bit (at (2) ) 

CALL  send_real_32bit (at (3) ) 

CALL  send_real_32bit (delxd) 

CALL  send_real_32bit (delyd) 

CALL  send_real_32bit (delzd) 

CALL  send_real_32bit (pm(l) ) 

CALL  send_real_32bit (pm(2) ) 

CALL  send_real_32bit {pm(3) ) 

c - receive  parameters  from  partition  #1 - c 

CALL  receive_real_32bit (gr (1) ) 

CALL  receive_real_32bit (gr (2) ) 

CALL  receive_real_32bit (gr (3) ) 

CALL  receive_real_32bit (mvs) 

CALL  receive_real_32bit (uvs (1) ) 

CALL  receive_real_32bit (uvs (2) ) 

CALL  receive_real_32bit (uvs (3) ) 

CALL  receive_real_32bit (delphi) 

CALL  receive_real_32bit (deltht) 

CALL  receive_real_32bit (delpsi) 

CALL  receive_real_32bit (delu) 

CALL  receive_real_32bit (delv) 

CALL  receive_real_32bit (delw) 

Q*  it  it  if  it  it  if  -k  it  -k  it  ifk  ic  -k  -k  it  if  -k  -k  -k  -k  -k  -k  *  *  *  -k  it  It  if  *  it  -k  *  it  it  -k  it  -k  it  it  it  it  *  *  -k  -k  *  -k  it  -k  ir  -k  -k  *  *  it  -k  it  it  -k  'k  it  in  -k  it  "k 

C  * 

c  partition  4  * 

c  * 

Qiticickkkitititititkkkkitkkkitititkkkititkitkkititkitititititkititickititkitkkkititkiticititititkkkititkitititkk 

Q - navigation  module - c 

CALL  navig (delphi,  deltht,  delpsi,  delu,  delv,  delw,  gr,  t,  sq, 

&  sr,  ti2m,  at,  delxd,  delyd,  delzd) 
c  integrate  performance  velocity  remaining  using  navigation  output 
IF  (t  .LT.  tst2on  .OR.  t  .GE.  tstg2)  THEN 
mvrdot  =  0.0 
ELSE 

mvrdot  =  -  sqrt (at (1) **2  +  at(2)**2  +  at(3)**2) 

END  IF 

mvr  =  mvr  +  delt*mvrdot 
IF  (mvr  .LT.  0.0)  mvr  =  0.0 

kkirkkkkkkkkkkkitititickirkirkiekkkkkiekkit 

c  * 

c  end  of  partition  4  * 


c  * 

c  partition  5  * 

c  * 

c - on  board  guidance  processing - 


IF  (tstep  .GE.  tgpu)  THEN 
tgpu  =  tgpu  +  dtbgu 
dt  =  t  -  tlgpu 
tlgpu  =  t 

c  integrate  guidance  .states  from  last  pass  through 
us(l)  =  us(l)  +  dt*usd(l) 

us  (2)  =  us (2)  +  dt*usd(2) 

us  (3)  =  us (3)  +  dt*usd(3) 

pg(l)  =  pg(l)  +  dt*pgd(l) 

pg(2)  =  pg(2)  +  dt*pgd(2) 
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pg(3)  =  pg(3)  +  cit*pgd(3) 

vw(l)  =  vw(l)  +  cit*vwd(l) 

vw(2)  =  vw(2)  +  dt*vwd(2) 

vw(3)  =  vw(3)  +  dt*vwd(3) 

dtmpl  =  sqrt (pg (1) **2  +  pg(2)**2  +  pg(3)**2) 
pg(l)  =  pg{l) /dtmpl 
pg(2)  =  pg{2) /dtmpl 
pg(3)  =  pg (3) /dtmpl 

c -  boost  steering  module  - c 

IF  (t  .LT.  tstg2)  THEN 

CALL  bsteer{t,  us,  uvs,  mvs,  mvr,  at,  usd,  ac) 

c -  boost  guidance  module  - c 

CALL  bguid(t,  at,  ac,  ti2m,  pg,  vw,  pgd,  vwd,  psier,  thter, 

&  pm) 

ELSE 

CALL  receive_real_32bit (attlm) 

END  IF 

IF  <t  .GE.  tstg2)  THEN 
usd(l)  =  0.0 
usd(2)  =  0.0 
usd(3)  =  0.0 
pgdU)  -  0.0 
pgd (2)  =0.0 
pgd (3)  =  0.0 
vwd ( 1 )  =  0.0 
vwd (2)  =  0.0 
vwd ( 3 )  =  0.0 
END  IF 
ELSE 

CALL  receive_real_32bit (attlm) 

END  IF 

CALL  send_real_32bit (psier) 

CALL  send_real_32bit (thter) 

CALL  send_real_32bit (sq) 

CALL  send_real_32bit (sr) 

c  * 

c  end  of  partition  5  * 

c  * 

Qit  it  it  it  ic  i€  "k  i(  it  it  ■k  it  it  it  ic  ic  it  ic  i(  it  ic  -k  it  it  if  it  ■it  if  it  i(  -k  -k  it  it  -M  it  it  it  it  if  it  "k  "k  ic  if  i(  it  -k  it  it  ic  -k  it  it  it  it  i(  if  it  it  if  it  it  -k  it  if  -k  it  ic  it  "it 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  50 

END 
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A.1.13  Boost2cl.for 

PROGR/'M  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  pulsegO) 

REAL  eg (3) 

REAL  pulsea{3) 

REAL  delu,  delv,  delw 
#include  "include/constant .dat" 

DATA  delu/0.0/,  delv/0.0/,  delw/0.0/ 

c  initialize  time 
tstep  =0.0 
t  =  tstep  *  delt 


c- 

c- 

c- 


-c 

-c 

-c 


main  execution  loop 


10  CONTINUE 

c -  receive  parameters  from  partition  #1  - c 

CALL  receive_real_32bit (eg (1) ) 

CALL  receive_real_32bit (eg (2) ) 

CALL  receive_real_32bit (eg (3) ) 

CALL  receive_real_32bit (p) 

CALL  receive_real_32bit (q) 

CALL  receive_real_32bit (r) 

CALL  receive_real_32bit (ud) 

CALL  receive_real_32bit (vd) 

CALL  receive_real~32bit (wd) 

CALL  receive_real~32bit (pd) 

CALL  receive_real_32bit (qd) 

CALL  receive_real_32bit (rd) 

c  * 

c  partition  3  * 

c  * 

Qit-^c'k'kififiKifit-k-k-Mificic-kifif-k-k'k'k'k-k-kit-kif-k-^-kic-k’k-kitititif-kic'kit-k'kicifif'kiK-kic-kicic'k-kic-k-k'kiciricic-kifkick* 

c - inertial  measurement  update - c 

CALL  gyro(p,  q,  r,  t,  pulseg) 

c - inertial  measurement  update - c 

CALL  acceKud,  vd,  wd,  p,  q,  r,  pd,  qd,  rd,  eg,  t,  pulsea) 

c - imu  processor  module - c 

CALL  imupro (pulsea,  pulseg,  delphi,  deltht,  delpsi,  delu,  delv, 

&  delw) 

CALL  send_real_32bit (delphi) 

CALL  send_real_32bit (deltht) 

CALL  send_real_32bit (delpsi) 

CALL  send_real_32bit (delu) 

CALL  send_real_32bit (delv) 

CALL  send_real_32bit (delw) 

c  * 

c  end  of  partition  3  * 

c  * 

Q*  *  *  it  *  "k  ie  -k  -k  ic  if  -k  -k  ie  -k  -k  -k  ick  is  ■k  ii  it  -k  ^  -k  -k  -k  -k  ic  'k  ic  it  it  *  *  *  it  -k  -k  it  icit  it  -k  it  it  -k  it  -k  it  -k  it  -kit  i(  if  it  -k  -k  -k  -k  icif  -k  -k  -k  -k  *  *  it 


c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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Appendix  A  -  Exosim  v  1 .0  Boost  Phase 


A.  1.14  Boost2c2.for 

PROGRAM  main 

IMPLICIT  DOUBLEPRECISION (a-h,  o-z) 

DOUBLE  PRECISION  vmir(3),  rmir(3) 

DOUBLE  PRECISION  xyze(3) 

DOUBLE  PRECISION  xyzed{3) 

DOUBLE  PRECISION  cei( 9) ,  latlp,  longlp 
REAL  at (3),  delxd,  delyd,  delzd,  mvs,  uvs{3) 

REAL  t,  tst2on,  dtcvu,  delt,  tpico,  tstg2 
REAL  mvr,  mvrdot,  vtt(3),  vpl 
REAL  tcorv,  vg(3),  epsl 
#include  "include/constant .dat" 

DATA  tst2on/22.995/ 

DATA  dtcvu/50.0/,  epsl/2 . 5e-04/ 

DATA  dtr/0. 017453292519943296/ 

DATA  latlp/0.0/,  longlp/0.0/,  vpl/13770.0/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 

DO  10  i  =  1,  3 
xyze{i)  =  0.0 
xyzed(i)  =  0.0 
vtt{i)  =0.0 
vg ( i )  =0.0 
10  CONTINUE 

xyzed)  =  20898908.0 
vg(l)  =  5000.0 
vg(3)  =  9350.0 
mvrdot  =  0.0 

c - c 

c - missile  state  initialization  module - c 

c - c 

c  initialize  states  and  state  derivatives 

CALL  mmk (-90 . 0*dtr,  1,  latlp*dtr,  2,  longlp*dtr,  3,  cei) 

CALL  vecrot (xyzed,  cei,  vmir) 

CALL  vecrot (xyze,  cei,  rmir) 

CALL  incorv(vg,  rmir,  vmir,  mvs,  uvs) 
mvr  =  vpl 


tcorv  =  0.0 
istart  =  0 

c - c 

c - main  execution  loop - c 

c - c 

20  CONTINUE 

C  * 

c  partition  4  * 

c  * 


CALL  send_real_32bit (mvs) 

CALL  send_real_32bit (uvs (1) ) 
CALL  send_real_32bit (uvs (2) ) 
CALL  send_real_32bit (uvs (3) ) 
CALL  receive_real_32bit (at (1) ) 
CALL  receive_real_32biL (at (2) ) 
CALL  receive_real_32bit (at (3) ) 
CALL  receive_real_32bit (delxd) 
CALL  receive_real_32bit (delyd) 
CALL  receive_real_32bit (delzd) 
IF  (istart  .EQ.  0)  THEN 
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istart 
ELSE 
rmir (1) 
rmir (2) 
rmir (3) 
vmir (1) 
vmir (2) 
vmir (3) 


=  1 


rmir (1) 
rmir (2) 
rmir (3) 
vmir (1) 
vmir (2) 
vmir  (3) 


0 . 5d0*delxci)  *delt 
0 . 5d0*delyd) *delt 
0.5d0*del2d) *delt 


+  (vmir(l)  + 

+  (vmir(2)  + 

+  (vmir(3)  + 

+  delxd 
+  delyd 
+  delzd 

c  integrate  performance  velocity  remaining  using  navigation  output 
IF  (t  -  delt  .LT.  tst2on  .OR.  t  -  delt  .GE.  tstg2)  THEN 
mvrdot  =  0.0 
ELSE 

mvrdot  =  -  sqrt (at (1) **2  +  at{2)**2  +  at(3)**2) 

ENDIF 

mvr  =  mvr  +  delt*mvrdot 
IF  (mvr  .LT.  0.0)  mvr  =  0.0 
c  integrate  gravity  compensated  acceleration 
vtt(l)  =  vtt(l)  +  delt*at{l) 

vtt(2)  =  vtt(2)  +  delt*at(2) 

vtt(3)  =  vtt(3)  +  deit*at(3) 

ENDIF 

c -  correlated  velocity  module  - c 

IF  (tstep  .GE.  tcorv)  THEN 

CALL  corveKmvr,  t,  vtt,  rmir,  vmir,  vg,  mvs,  uvs) 
tcorv  =  tcorv  +  dtcvu 
ENDIF 

Q-k  -k  ic  it  it  it  ^  it  itit  •*{  -k  it  -k  it  it  it  -k  -k  *  i(  "k  it  it  it  -k  if  *  it  it  it  it  it  it  it  it  -k  -k  -k  it  ir  it  it  it  it  it  it  it  -k  it  ie  *  icit  ic*  ic  -k  it  -k  if  -k  if  it  it  it  it  *  ic 

c  * 

c  end  of  partition  4  * 

c  * 

Q************************  *******************************  *  *************** 


c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  20 

END 
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A.  1.15  Cgl23.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  0-z) 

REAL  masstl (20) ,  cgx(20),  cgy(20),  cgz(20) 
REAL  mass,  eg (3) 
finclude  "include/constant .dat" 

#include  "include /masstl .dat" 

#include  "include/cgx.dat" 

#include  "include/cgy .dat" 

#include  " include /cgz .dat" 

DATA  cg{l)/0.0/,  cg(2)/0.0/,  cg(3)/0.0/ 
DATA  itable/0/ 

c  initialize  time 
tstep  =0.0 
t  =  tstep  *  delt 


10  CONTINUE 

CALL  send_real_32bit (cg(l) ) 
CALL  send_real_32bit (eg (2) ) 
CALL  send_real_32bit (eg (3) ) 
CALL  receive_ real_32Dit (mass) 


CALL 

table (masstl, 

cgx. 

mass. 

eg ( 1 ) , 

20, 

itable) 

CALL 

table (masstl. 

egy. 

mass. 

cg(2) , 

20, 

itable) 

CALL 

table (masstl. 

cgz, 

mass. 

cg(3) , 

20, 

itable) 

CALL  send_real_32bit (eg (1) ) 
CALL  send_real_32bit (eg (2) ) 
CALL  send_real_32bit (cg(3) ) 

c  increment  time 

tstep  =  tstep  +1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.  1.16  Cne.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  cnale(205),  cna2e(205) 
REAL  estmch,  cne 
#include  "include/constant .dat" 
finclude  "include/cnale .dat" 
#include  "include/cna2e .dat" 

DATA  icnmle/0/,  icnale/0/ 
DATA  icnm2e/0/,  icna2e/0/ 
DATA  tapu/0.0/,  dtapu/5.0/ 

c  initialize  time 
tstep  =  0.0 
t  “  tstep  *  delt 


10  CONTINUE 

CALL  receive_real_32bit (estmch) 

IF  (tstep  .GE.  tapu)  THEN 
tapu  =  tapu  +  dtapu 
IF  (t  .LT.  tstg2)  THEN 
IF  (t  .LT.  tstgl)  THEN 

CALL  tlu2ei (estmch,  4.0e0,  cnale,  icnmle,  icnale,  cne) 
ELSE 

CALL  tlu2ei (estmch,  4.0e0,  cna2e,  icnm2e,  icna2e,  cne) 
END  IF 
ENDIF 
ENDIF 

CALL  send_real_32bit (cne) 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.1.17  Inerxyz.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  masstl (20) ,  inerxx(20),  ineryy(20),  inerzz(20) 
REAL  ixx,  iyy,  izz 
REAL  mass 

finclude  "include/constant .dat" 
tinclude  "include/masstl .dat" 

#include  "include/inerxx.dat" 
finclude  "include/ineryy .dat" 
tinclude  "include/inerzz .dat" 

DATA  ixx/0.0/,  iyy/0.0/,  izz/0.0/ 

DATA  itable/0/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 


10  CONTINUE 

CALL  send_real_32bit (iyy) 

CALL  receive_real_32bit (mass) 

CALL  table (masstl,  inerxx,  mass,  ixx,  20,  itable) 

CALL  table (masstl,  ineryy,  mass,  iyy,  20,  itable) 

CALL  table (masstl,  inerzz,  mass,  izz,  20,  itable) 

CALL  send_real_32bit (ixx) 

CALL  send_real_32bit Uyy) 

CALL  send_real_32bit (izz) 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.  1.18  Press.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  altt(59),  presst (59) 
finclude  " include /constant .dat" 

#include  "include/altt .dat" 

#include  "include/presst .dat" 

DATA  itable/0/ 

c  initialize  time 
tstep  »  0.0 
t  “  tstep  *  delt 

press  =  0.0 

10  CONTINUE 

CALL  send_real_32bit (press) 

CALL  receive_real_32bit (alt) 

CALL  table (altt,  presst,  alt,  press,  59,  itable) 

c  increment  time 

tstep  =  tstep  +1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.1.19  Print.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 
c  INCLUDE  ' :pfp: include/target. for' 

REAL  garbage 
REAL  t 

REAL  alt,  X,  y,  z 

REAL  velocity,  vrwmx,  vrwmy,  vrwmz 
REAL  phi,  tht,  psi 
#include  "include/constant .dat" 

DATA  tprt/0.0/,  dtprt/100.0/ 

C’tLL  receive_real_32bit  (garbage) 

c  initialize  time 
tstep  =0.0 
t  =  tstep  *  delt 


c 

c 

c 

c 


* 


main  execution  loop 


10  CONTINUE 


-  receive  parameters  from  partition  #1  — 

CALL  receive_real_32bit (vrwmx) 

CALL  receive_real_32bit (vrwmy) 

CALL  receive_real_32bit (vrwmz) 

CALL  receive_rea.l_32bit  (phi) 

CALL  receive_reaj._32bit  (tht) 

CALL  receive_real~32bit (psi) 

CALL  receive~real_32bit (x) 

CALL  receive_real_32bit (y) 

CALL  receive_real_32bit (z) 

CALL  receive_real_32bit (alt) 

IF  (tstep  .GE.  tprt)  THEN 

velocity  =  sqrt (vrwmx  *  vrwmx  +  vrwmy 


vrwmz) 


tprt 
END  IF 


CALL  send_host_real (t) 

CALL  send_host_real (alt) 

CALL  send_host_real (x) 

CALL  send_host_real (y) 

CALL  send_host_real (z) 

CALL  send_host_real (velocity) 
CALL  send_host_real (vrwmx) 
CALL  send_host_real (vrwmy) 
CALL  send_host_real (vrwmz) 
CALL  send_host_real (phi) 

CALL  send_host_real (tht) 

CALL  send_host_real (psi) 
tprt  +  dtprt 


* 


c 

c 

c 

c 


vrwmy  +  vrwmz 


c  increment  time 

tstep  =  tstep  +1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 
END 


69 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


A.1.20  Rho.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  altt(59) ,  rhot{59) 

REAL  alt,  rho 

#include  "include/constant .dat" 
tinclude  "include/constant .dat" 

#include  "include/altt .dat" 
tinclude  "include/rhot .dat" 

DATA  itable/0/ 

DATA  slglbm/32. 174048/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 

rho  =  0.0 

10  COKTINUE 

CALL  receive_real_  32bit(alt) 

CALL  t.ble{altt,  rhot,  alt,  rho,  59,  itable) 
rho  =  ’■110*1 .  Oe-6/slglbm 
rhod2  =  rho/ 2 . 0 

CALL  send_real_32bit {rhod2) 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstu.p  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.  1.21  Shear.for 

PROGRAM  main 
IMPLICIT  REAL{a-h,  0-z) 

REAL  altt(59),  sheart(59) 

REAL  alt,  shear 

finclude  "include/constant .dat" 

#include  "include/altt .dat" 

#include  "include/sheart .dat" 

DATA  itable/0/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 

shear  =0.0 

10  CONTINUE 

CALL  receive_real_32bit (alt) 

CALL  table (altt,  sheart,  alt,  shear,  59,  itable) 

CALL  send_real_32bit (shear) 

c  increment  time 

tscep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.i.22  Target.for 


PROGRAM  main 


subroutine  : 

target (t, rtic, vtic) 

function  : 

computes  the  rotational  and  translational 
target  states 

inputs  : 

t 

outputs  : 

rtic, vtic 

IMPLICIT  DOUBLEPRECISION (a-h,  o-z) 

DOUBLE  PRECISION  grt(3),  rtic(3),  vtic(3) 
DOUBLE  PRECISION  urtic(3),  mrtic,  mgrt 
INTEGER  first 1 

#include  "include/constant .dat" 

DATA  firstl/1/,  gmu/1 . 4052477el6/ 

DATA  rtic/22462673.6,  0.0,  3781781.71/ 
DATA  vtic/-6858.46,  0.0,  -18411.68/ 

c  initialize  time 
tstep  =0.0 
t  =  tstep  *  delt 


10  CONTINUE 

CALL  receive_real_32bit (  alt  ) 

CALL  magt<rtic,  mrtic,  urtic) 
mgrt  =  gmu/mrtic**2 
CALL  mvbys(-mgrt,  urtic,  grt) 
c  integrate  target  acceleration  and  velocity 
IF  (fi.'Stl  .EQ.  1)  THEN 
Eirstl  =  0 
til  =  t 
ELSE 

tdelt  =  t  -  til 
til  =  t 

DO  20  i  =  1,  3 

rtic(i)  =  rticd)  +  vtic (i)  *tdelt  +  0 . 5d0*grt  (i)  *tdelt*tdelt 
vtic(i)  =  vtic(i)  +  grt(i)*tdelt 
20  CONTINUE 
ENDIF 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.1.23  Vsnd.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 
REAL  altt(59),  vsndt{59) 
REAL  alt,  vsnd 

#include  "include/constant .dat" 
tinclude  "include/altt .dat" 
tinclude  " include /vsndt .dat" 
DATA  itable/0/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 


10  CONTINUE 

CALL  receive_real_32bit (alt) 

CALL  table (altt,  vsndt,  alt,  vsnd,  59,  itable) 

CALL  send_real_32bit (vsnd) 

c  increment  time 

tstep  =  tstep  +  1.0 
t  »  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.1.24  Vwind.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 
REAL  altt(59),  vwindt(59) 
REAL  alt,  vwind 

tinclude  "include/constant .dat" 
♦include  "include/altt .dat" 
♦include  "include/vwindt .dat" 
DATA  itable/0/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 


10  CONTINUE 

CALL  receive_real_32bit (alt) 

CALL  table (altt,  vwindt,  alt,  vwind,  59,  itable) 

CALL  send_real_32bit (vwind) 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.1.25  Windir.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  altt(59),  windirt(59) 

REAL  alt,  windir 
#include  "include/constant .dat" 
finclude  "include/altt .dat" 

#include  "include/windirt .dat" 

DATA  itable/0/ 

DATA  dtr/0. 017453292519943296/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 


10  CONTINUE 

CALL  receive_real_32bit (alt) 

CALL  table  (altt,  windirt,  alt,  windir,  59,  itable) 
swdir  =  sin (windir*dtr) 
cwdir  =  cos (windir*dtr) 

CALL  send_real_32bit (swdir) 

CALL  send_real_32bit (cwdir) 

c  increment  time 

tstep  =  tstep  +1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 
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A.1.26  Xcpe.for 

PROGRAM  main 
IMPLICIT  REAL(a-h,  o-z) 

REAL  xcplle (205) ,  xcpl2e(205) 
REAL  estmch,  alfate,  xcpe 
finclude  "include/constant .dat" 
#include  "include/xcplle .dat" 
#include  "include/xcpl2e .dat" 

DATA  icpmle/0/,  icpale/0/ 
DATA  icpm2e/0/,  icpa2e/0/ 
DATA  tapu/0.0/,  dtapu/5.0/ 

c  initialize  time 
tstep  =  0.0 
t  =  tstep  *  delt 


10  CONTINUE 

CALL  receive_real_32bit (estmch) 

CALL  receive_real_32bit (alfate) 

IF  (tstep  .GE.  tapu)  THEN 
tapu  =  tapu  +  dtapu 
IF  (t  .LT.  tstg2)  THEN 
IF  (t  .LT.  tstgl)  THEN 

CALL  tlu2ei (estmch,  alfate,  xcplle,  icpmle,  icpale,  xcpe) 
ELSE 

CALL  tlu2ei (estmch,  alfate,  xcpl2e,  icpm2e,  icpa2e,  xcpe) 
END  IF 
ENDIF 
ENDIF 

CALL  send_real_32bit (xcpe) 

c  increment  time 

tstep  =  tstep  +  1.0 
t  =  tstep  *  delt 

IF  (t  .LT.  tfinal)  GOTO  10 

END 


76 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


A.2  Utilities  (FORTRAN) 


A.2.1  Accel.for 

SUBROUTINE  accel(ud,  vd,  wd,  p,  q,  r,  pd,  qd,  rd,  eg,  t,  pulsea) 

c - 

c  function  : 

c 
c 
c 
c 

c  inputs  : 

c  both  : 


IMPLICIT  REAL(a-h,  o-z) 

REAL  sfwidO),  sfla(3),  sf2a(3),  qfraca(3),  dca{3) 

REAL  sfea{3),  wdra(3),  dvel(3),  pulsea (3),  pqr(3),  pqrd(3) 

REAL  limu(3),  dural  (3),  dum2(3),  dum3(3),  ximu(3) 

REAL  eg (3) 

INTEGER  gyseed 

DATA  limu/-2.0,  2*0.0/,  imuoff/0/,  gyseed/123/,  sppa/0.0/ 

DATA  qfraca/3*0 . 0/,  sfla,  sf2a/6*0.0/,  drmena/0.0/,  dca/3*0.0/ 
DATA  thxya,  thxza,  thyxa,  thyza,  thzxa,  thzya/6*0.0/ 

DATA  phia,  thta,  psia/3*0.0/,  drsiga/0.0/ 

#include  " . . /include/constant . dat" 

c  sensor  acceleration  due  to  package  offset  from  the  eg 
IF  (imuoff  .EQ.  0)  THEN 
udr  =  ud 
vdr  =  vd 
wdr  =  wd 
ELSE 

CALL  spvecsub{cg,  limu,  ximu) 

CALL  vmk{pd,  qd,  rd,  pqrd) 

CALL  vmk{p,  q,  r,  pqr) 

CALL  sperosst (pqrd,  ximu,  duml) 

CALL  sperosst (pqr,  ximu,  dum2) 

CALL  sperosst (pqr,  dum2,  dum3) 
udr  =  ud  +  duml(l)  +  dum3(l) 
vdr  =  vd  +  duml (2)  +  dum3(2) 
wdr  =  wd  +  duml (3)  +  dum3(3) 

ENDIF 

c  accelerometer  axis  misalignment  effects 
udm  =  udr  +  vdr*psia  -  wdr*thta 
vdm  =  -  udr*psia  +  vdr  +  wdr*phia 

wdm  =  udr*thta  -  vdr*phia  +  wdr 
c  accelerometer  axis  nonorthogonality  effects 
udn  =  udm  +  vdm*thxza  -  wdra*thxya 
vdn  =  -  udm*thyza  +  vdm  +  wdm*thyxa 

wdn  =  udm*thzya  -  vdm*thzxa  +  wdm 
c  compute  scale  factor  errors 

sfwia(l)  =  sfla(l)*udn  +  sf2a (1) *udn**2 
sfwia(2)  =  sfla(2)*vdn  +  sf2a (2) *vdn**2 
sfwia(3)  =  sfla(3)*wdn  +  sf2a (3) *wdn**2 
s£ea(l)  =  udn  +  sfwia(l) 

sfea(2)  =  vdn  +  sfwia(2) 

sfea{3)  =  wdn  sfwia(3) 

IF  (t  ,GT.  0.0)  THEN 

DO  10  i  =  1,  3 

c  make  a  gaussian  draw  for  random  drift  and  add  to  constant  drift 
CALL  norml (drsiga,  drmena,  gyseed,  dra) 
wdra(i)  =  dra  +  dca(i) 
c  compute  delta  velocity 


accelerometer  model  computes  sensed  delta 
velocity  counts,  includes  rotational 
effects, axis  misalignment  and  nonorthogo¬ 
nality  errors,  scale  factor  errors,  random 
and  constant  drift  and  quantization, 
ud,  vd,  wd,  p,  q,  r,  pd,  qd,  rd,  eg,  t 
pulsea 
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dvel(i)  =  delt* (sfea (i)  +  wdra(i)) 

IF  (sppa  .GT.  0.0)  THEN 
c  unquantized  output  in  counts 

qfraca(i)  =  qfraca<i)  -  pulsea(i)  +  dvel{i)/sppa 
c  quantized  output  in  counts 

pulsea(i)  =  aint (qf raca (i) ) 

ELSE 

pulsea(i)  =  dvel(i) 

ENDIF 

10  CONTINUE 
ELSE 

c  initialize  quantization  output  values  to  zero  on  first  pass 
DO  20  i  =  1,  3 
qfraca(i)  =  0.0 
pulsea(i)  =  0.0 
20  CONTINUE 
ENDIF 
RETURN 
END 
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A.2.2  Bguid.for 


SUBROUTINE  bguid(t,  at,  ac,  ti2m,  pg,  vw,  pgd,  vwd,  psier,  thter, 
&  pm) 


c - 

c 

function  : 

to  calculate  the  error  between 

the  commanded 

c 

pointing  vector  and  the  actual 

direction  the 

c 

c 

inputs  : 

missile  is  flying  during  boost 
t,at,ac,ti2m, pg 

c 

outputs  : 

pgd, vwd, psier,  thter,  pm 

c 

c - 

both  : 

VW 

IMPLICIT  REAL(a-h,  o-z) 

REAL  vwd(3),  vw(3),  wc(3),  pgd(3),  pg(3),  at  (3),  ac 
&  (3) 

REAL  ti2m(9),  ka,  kal,  ka2,  ka3,  ka4,  kaS 
REAL  kv,  kvl,  kv2,  kv3,  kv4,  kv5 
REAL  pm(3),  psier,  thter,  attlm 

DATA  kal/. 0015/,  ka2/.0015/,  ka3/.0013/,  ka4/.011/,  ka5/.0045/ 
DATA  kvl/. 00013/,  kv2/. 00013/,  kv3/0.0/,  kv4/0.0/,  kv5/0.0/ 
DATA  tc/0.75/,  ts/14.5/,  t5/46.0/,  t2s/58.2/,  tcd 
&  /60.2/ 

DATA  iminsf/0/,  vwlim/10.0/,  wlim/0.3/ 

#include  " . . /include/constant .dat" 

IF  (t  .LE.  ts)  THEN 
ka  =  kal 
kv  =  kvl 

ELSEIF  (t  .LE.  tstgl)  THEN 
ka  =  ka2 
kv  =  kv2 

ELSEIF  (t  .LE.  t5)  THEN 
ka  =  ka3 
kv  =  kv3 

ELSEIF  (t  .LE.  t2s)  THEN 
ka  =  ka4 
kv  =  kv4 
ELSE 

ka  =  ka5 
kv  =  kv5 
END  IF 

c  launch  steering  mode 

IF  (t  .LE.  tc)  THEN 

CALL  spcrosst(at,  ac,  vwd) 

wc(l)  =0.0 

wc(2)  =0,0 

wc(3)  =0.0 

pgd ( 1 )  =0.0 

pgd (2)  =0.0 

pgd(3)  =  0.0 

c  minimum  impulse  steering  mode 
ELSEIF  (t  .LE.  t5)  THEN 
IF  (iminsf  .EQ.  0)  THEN 
CALL  xferb(ac,  3,  pg) 
iminsf  =  1 
END  IF 

CALL  spcros.st  (at,  ac,  vwd) 

wc(l)  =  ka*vwd(l)  +  kv*vw(l) 

wc(2)  =  ka*vwd(2)  +  kv*vw(2) 

wc(3)  =  ka*vwd(3)  +  kv*vw(3) 

wcmax  =  amaxl (abs (wc (1) ) ,  abs(wc(2)),  abs{wc(3))) 

IF  (wcmax  .GT.  wlim)  THEN 
scale  =  wlim/wcmax 
CALL  spmvbys (scale,  wc,  wc) 
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END  IF 

CALL  spcrosst (wc,  pg,  pgd) 
c  generalized  energy  management  steering  mode 
ELSEIF  (t  .LE.  ted)  THEN 
CALL  spcrosst (at,  ac,  vwd) 

vwmax  =  amaxl (abs (vw(l) ) ,  abs(vw(2)),  abs{vw(3))) 
IF  (vwmax  .GT.  vwlim)  THEN 
scale  =  vwlim/vwmax 
CALL  spmvbys (scale,  vw,  vw) 

END  IF 

wc(l)  =  ka*vwd(l)  +  kv*vw(l) 

wc(2)  =  ka*vwd(2)  +  kv*vw(2) 

wc(3)  =  ka*vwd(3)  +  kv*vw(3) 

wemax  =  amaxl (abs (wc (1) ) ,  abs(wc(2)),  abs(wc(3))) 
IF  (wemax  .GT.  wlim)  THEN 
scale  =  wlim/wcmax 
CALL  spmvbys (scale,  wc,  wc) 

ENDIF 

CALL  spcrosst (wc,  pg,  pgd) 
c  countdown  steering  mode 
ELSE 

CALL  spcrosst (at,  ac,  vwd) 

vwmax  =  amaxl (abs (vw(l) ) ,  abs(vw(2)),  abs(vw(3))) 
IF  (vwmax  .GT.  vwlim)  THEN 
scale  =  vwlim/vwmax 
CALL  spmvbys (scale,  vw,  vw) 

ENDIF 

wc(l)  =  0.0 
wc(2)  =  0.0 
wc(3)  =  0.0 
pgd(l)  =0.0 
pgd (2)  =0.0 
pgd ( 3 )  =  0.0 
ENDIF 

call  spvecrot (pg,ti2m,pm) 
psier  =  pm(2) 
thter  =  -  pm (3) 

CALL  receive_real_32bit (attlm) 
toterr  =  sqrt (psier**2  +  thter**2) 

IF  (toterr  .GT.  attlm)  THEN 
psier  =  psier*attlm/toterr 
thter  =  thter*attlm/toterr 
ENDIF 
RETURN 
END 
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A.2.3  Bsteer.for 


SUBROUTINE  bsteer(t,  us,  uvs,  mvs,  mvr,  at,  usd,  ac) 


c - 

c 

boost 

function  : 

calculates  the  steering  commands  for  the 

c 

phase  of  flight 

c 

inputs  : 

t, uvs, mvs, mvr,  at 

c 

outputs  : 

usd, ac 

c 

c - 

both  : 

us 

IMPLICIT  REAL(a-h,  o-z) 

REALusfO),  uvs(3),  dbar(3),  usd(3),  at(3) 

REAL  us  (3),  ac(3),  bbar(3),  bigac(3),  bigb(3),  mvs, 

&  mvr 

REAL  ksl,  kb,  mbigac,  mbigb 

DATA  ksl/0.1./,  kb/2.4495/,  dbar/0.0,  -1.0,  0.0/ 

DATA  tc/0.75/,  t5/46.0/,  tcd/60.2/,  usfd/-35.0/,  psiO/0.0/ 
DATA  dtr/0. 017453292519943296/ 
c  launch  steering  logic 
IF  (t  .LE.  to  THEN 
usd(l)  =  0.0 
usd(2)  =  0.0 
usd(3)  =  0.0 
CALL  xferb(us,  3,  ac) 
usf(l)  =  cos (psiO) *cos (usfd*dtr) 
usf(2)  =  sin (psiO) *cos (usfd*dtr) 
usf{3)  =  -  sin (usfd*dtr) 

c  minimum  impulse  steering  (mins)  logic 
ELSEIF  (t  .LE.  t5)  THEN 
CALL  dott(us,  usf,  usdot) 
usd(l)  =  ksl* (usf (1)  -  usdot*us(l)) 
usd(2)  =  ksl* (usf (2)  -  usdot*us(2)) 
usd(3)  =  ksl*  (usf (3)  -  usdot*us{3)) 

CALL  xferb(us,  3,  ac) 

c  general  energy  management  (gems)  steering  logic 
ELSEIF  (t  .LE.  ted)  THEN 
usd(l)  =  0.0 
usd(2)  =  0.0 
usd(3)  =  0.0 
CALL  xferb(uvs,  3,  us) 

CALL  sperosst (dbar,  us,  bigb) 

CALL  spmagt (bigb,  mbigb,  bbar) 

IF  (mvr  .NE.  0.0)  vratio  =  mvs/mvr 
IF  (mvs  .LE.  mvr)  THEN 

wastan  =  kb*  (1.0  -  vratio) **0.5 
ELSE 

wastan  =  0.0 
ENDIF 

sinwan  =  vratio*wastan 
coswan  =  (1.0  -  (wastan**2/2 . 0) ) 
bigac(l)  =  us(l)*coswan  -  bbar (1) *sinwan 
bigac(2)  =  us(2)*coswan  -  bbar (2) *sinwan 
bigac(3)  =  us(3)*coswan  -  bbar (3) *sinwan 
CALL  spmagt (bigac,  mbigac,  ac) 
c  countdown  steering  logic 
ELSE 

CALL  xferb(us,  3,  ac) 

ENDIF 

RETURN 

END 
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A.2.4  Bthrst.for 


c 

c 

c 

c 

c 

c 


SUBROUTINE  bthrst{t,  eg,  press,  dip,  dly,  fxt,  fyt,  fzt,  mxt, 
&  myt,  mzt,  mdott) 


function  : 

inputs  : 
outputs  : 


computes  missile  thrust  vector  and  moments 
due  to  first  and  second  stage  boosters 
t, eg, press, dip, dly 
fxt, fyt, fzt, mxt, myt, mzt, mdott 


IMPLICIT  REAL(a-h,  o-z) 

REAL  timthl (26) ,  thrthl(26) 

REAL  timth2 (29) ,  thrth2(29) 

REAL  thrma(9) 

REAL  mxt,  myt,  mzt,  mdott 
REAL  eg (3),  press 
#include  " . . /include/constant .dat" 

#include  . /include/timthl .dat" 

#include  . /include/thrthl .dat" 

#include  ". . /include/timth2 .dat" 

♦include  ". . /include/thrth2 .dat" 

DATA  tign/0.01/,  tst2on/22 . 995/ 

DATA  bispl/273.7/,  bisp2/282 . 3/,  winsl/8.19/,  wins2/6.93/ 

DATA  xnoz/-12.5583/,  xnoz2/-7 . 39167/,  ib,  ithl,  ith2/3*0/ 

DATA  wpropl/710.28/,  wprop2/479 . 61/,  aexit/.305/,  aexit2/0.99/ 
DATA  thrma/1.0,  3*0.0,  1.0,  3*0.0,  1.0/,  slglbm/32 . 174048/ 
c  post  boost 

IF  (t  .GE.  tstg2)  THEN 
fxt  =  O.OeO 
fyt  *=  O.OeO 
fzt  =  O.OeO 
mxt  “  O.OeO 
myt  «  O.OeO 
mzt  =  O.OeO 
mdott  =  O.OeO 
ELSE 

IF  (t  .GE.  tstgl)  THEN 
to  =  t  -  tst2on 

CALL  table (timth2,  thrth2,  tO,  thrv,  29,  ith2) 
c  first  stage  boost 
ELSE 

to  =  t  -  tign 

CALL  table (timthl,  thrthl,  tO,  thrv,  26,  ithl) 

END  IF 

IF  (ib  .EQ.  0)  THEN 

eisp  =  bispl*wpropl/ (wpropl  +  winsl) 
ib  =  1 
END  IF 

IF  (abs(t  -  tstgl)  .LE.  dteps)  THEN 
aexit  =  aexit2 
xnoz  =  xnoz2 

eisp  =  bisp2*wprop2/ (wprop2  +  wins2) 

ENDIF 


thr  =  maxi (O.OeO,  thrv  -  aexit*press) 
fx  =  thr*cos (dip) *cos (dly) 
fy  =  -  thr*sin(dly) 

fz  =  thr*sin (dip) *cos (dly) 

fxt  =  fx*thrma(l)  +  fy*thrma(4)  +  fz*thrma(7) 

fyt  =  fx*thrma(2)  +  fy*thrma(5)  +  fz*thrma(8) 

fzt  =  fx*thrma(3)  +  fy*thrma(6)  +  fz*thrma(9) 

mxt  =  fyt*cg(3)  -  fzt*cg(2) 

myt  =  -  fxt*cg(3)  +  fzt*(cg(l)  -  xnoz) 

mzt  =  fxt*cg(2)  -  fyt*(cg(l)  -  xnoz) 
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mdott  =  thrv/ (eisp*slglbm) 
END  IF 
RETURN 
END 
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A.2.5  Bxi2fv.for 


‘:o'3ROUTINE  bxi2fv(fvm,  b,  fv) 


c 

function  : 

compute  quaternion  (fv)  attitude  parameters 

c 

from  a  body  to  inertial  transformation 

c 

matrix  (b)  and  set  the  square  of  magnitude 

c 

of  quaternion  to  (fvm) 

c 

inputs  : 

fvm,b 

c 

c— 

outputs  : 

i.v 

IMPLICIT  REAL{a-h,  o-z) 

DIMENSION  b{9) ,  fv(4) 

EQUIVALENCE  (t3,  q) ,  (bl,  aa) 

DATA  f4,  f2,  p25,  pOOOl/4.,  2.,  0.25,  0.0001/ 

DATA  fl,  fO/1.,  0./ 

t3  =  p25 

al  =  b(6)  -  b(8) 

32  =  b(7)  -  b(3) 
a3  =  *j(2)  -  b(4) 
tra  =  b(l)  +  bt5)  +  b(9)  +  fl 
IF  (tra  .LT.  pOOOl)  THEN 
iflag  =  0 
tra  =  f2  -  tra 
bl  =  t3*(b{l)  +  b{l)  +  tra) 

IF  (bl  .LT.  fO)  bl  =  fO 
fv(l)  =  sqrt (bl) 

IF  (fv(l)  .NE,  fO)  iflag  =  1 
bl  =  t3*(b(5)  +  b(5)  +  tra) 

IF  (bi  .LT.  fO)  bl  =  fO 
fv(2)  =  sqr  .  bl) 

IF  (iflag  .Eq.  1)  fv(2)  =  sign(fv(2),  b(2)  +  b(4)) 
bl  *  t3*(b(9)  +  b(9)  +  tra) 

IF  (bl  .LT.  fO)  bl  =  fO 
fv(3)  =  sqrt(bl) 

IF  (iflag  .EQ.  1)  fv(3)  =  sign(fv(3),  b(3)  +  b(7)) 

IF  (iflag  .NE.  1)  THEN 

IF  (fv(2)  .NE.  fO)  fv(3)  =  sign(fv(3),  b(6)  +  b(8)) 
END  IF 
aa  =  fO 
fv(4)  =  fO 
q  =  fO 

IF  (fv(l)  .NE.  fO)  THEN 
q  =  f4 

aa  =  aa  +  al/fv(l) 

ENDIF 

IF  (fv(2)  .NE.  fO)  THEN 
q  =  q  +  f4 
aa  =  aa  +  a2/fv(2) 

ENDIF 

IF  (fv(3)  .NE.  fO)  THEN 
q  =  q  +  f4 
aa  =  aa  +  a3/fv(3) 

ENDIF 

IF  (q  .NE.  fO)  fv(4)  =  aa/q 
ELSE 

fv(4)  =  sqrt (t3*tra) 
t3  =  t3/fv(4) 
fv(i)  =  t3*al 
fv(2)  =  t3*a2 
fv(3)  =  t3*a3 
ENDIF 

q  =  sqrt (fv(l) **2  +  fv(2)**2  +  fv(3)**2  +  fv(4)**2) 
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IF  (q  .NE.  fO)  THEN 
q  =  fvin/q 
fv(l)  =  q*fv(l) 
fv(2)  =  q*fv(2) 
fv(3)  =  q*fv(3) 
fv(4)  =  q*fv(4) 
END  IF 
RETURN 
END 
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A.2.6  Corvel.for 

SUBROUTINE  corveKmvr,  t,  vtt,  rmir,  vmir,  vg,  mvs,  uvs) 

c - 

c  function  :  calculates  the  correlated  velocity 

c  inputs  :  mvr, t, vtt, rmir, vmir 

c  outputs  :  mvs, uvs 

c  both  :  vg 

c - 

IMPLICIT  DOUBLEPRECISION ( a -h,  o-z) 

DOUBLE  PRECISION  rb(3),  vc(3) 

DOUBLE  PRECISION  urb(3),  urt(3),  tmpv(3),  utmpv(3),  uthp(3) 
DOUBLE  PRECISION  vphi(3),  rtpred(3) 

DOUBLE  PRECISION  vce(3),  vse(3) 

DOUBLE  PRECISION  dlv(3),  rmir (3),  vmir (3) 

DOUBLE  PRECISION  mrb,  mrt,  mtmpv,  mvce 
DOUBLE  PRECISION  mvse,  mdvt 
REAL  vge{3),  vttp{3) 

REAL  vd0(3),  mvs,  uvs (3),  vs (3),  t,  mvr,  tstg2,  vg(3),  vtt (3) 
DATA  rtpred/21227680.0,  0.0,  1168230.0/,  ttf/140.0/ 

DATA  fl/450.0/,  f2/-0.5/,  vd0/3*0.0/,  dlv/3*0.0/,  vttp/3*0.0/ 
DATA  gmu/1.4052477el6/ 

#include  ". . /include/constant .dat" 

estimate  velocity  to  be  gained  (vge)  ,  correlated  velocity  (vce)  , 
and  steering  velocity  (vse) 

DO  10  i  =  1,  3 

dlv(i)  =  vtt(i)  -  vttp(i) 
vge(i)  =  vg(i)  -  dlv{i) 
vce(i)  =  vge(i)  +  vmir(i) 
vse{i)  ”  vge(i)  -  vdO(i) 
vttp (i)  =  vtt (i) 

10  CONTINUE 

mvse  =  dsqrt (vse (1) **2  +  vse(2)**2  +  vse(3)**2) 
mdvt  =  dsqrt (dlv{l) **2  +  dlv(2)**2  +  dlv(3)**2) 

IP  (mvse  .GT.  mvr)  THEN 
scale3  =>  mvr/mvse 
ELSE 

scales  =1.0 
END  IF 

scalar  =  f2*mvr*scale3/ (fl  +  mdvt) 

IF  (t  .GE.  tstg2)  THEN 
rb(l)  =  rmir(l) 
rb(2)  =  rmir (2) 
rb(3)  =  rmir (3) 

ELSE 

rb(l)  =  rmir(l)  +  scalar*vse (1) 
rb(2)  =  rmir (2)  +  scalar*vse (2) 
rb(3)  =  rmir (3)  +  scalar*vse (3) 

ENDIF 

CALL  magt(rb,  mrb,  urb) 

CALL  magt (rtpred,  mrt,  urt) 

CALL  crosst(urb,  urt,  tmpv) 

CALL  magt (tmpv,  mtmpv,  utmpv) 

CALL  crosst (utmpv,  urb,  uthp) 

vhc  =  vce (1) *uthp (1)  +  vce (2) *uthp (2)  +  vce (3) *uthp (3) 
vcr  =  vce  (1)  *urb  (1)  +  vce  (2)  *urb  (2)  +  vce  (3)  *urb  (3) 

CALL  crosst (urb,  urt,  vphi) 

sinphi  =  dsqrt (vphi (1) **2  +  vphi(2)**2  +  vphi(3)**2) 
cosphi  =  urb  (1) *urt  (i)  +  urb  (2) *urt (2)  +  urb  (3) *urt  (3) 
mvce  =  dsqrt (vce (1) **2  +  vce(2)**2  +  vce(3)**2) 
w  =  vhc/mrb 
el  =  mrb*vhc**2/gmu 
ar  =  mrb/mrt 
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tp]  =  mvce**2*mrb/ginu 

hhh  =  el*sinphi**2* (2 . 0  -  tpl) 

sqrhhh  =  dsqrt(hhh) 

tl  =  el*sinphi/ (hhh*w) 

t2a  =  (1.0  -  el) /ar  +  1.0  -  ar*el 

t2b  =  (2.0*el  -  1.0  -  1 . 0/ar) *cosphi 

t2  =  t2a  +  t2b 

t3  =  2 . 0*el**2*sinphi**3/ (w*hhh*sqrhhh) 
t4a  =  sqrhhh 

t4b  =  el  +  ar*el  +  cosphi  -  1,0 

t4  =  arctan(t4a,  t4b) 

tffe  =  tl*t2  +  t3*t4 

ttfe  =  t  +  tffe 

tff  =  ttf  -  t 

deltf  =  tff  -  tffe 

a  =  2.0* (ar  -  cosphi) /sinphi  +  (vcr/vhc) 

b  =  a*vcr  -  vhc 

c  =  b*mrb/ginu 

d  =  c*el*sinphi**2 

e  =  d  +  hhh/vhc 

parhv  =  e*2 . 0 

partlv  =  (1.0/vhc  -  parhv/hhh) *tl 

part2v  =  (2 .0*el/vhc) * (2 .0*cosphi  -  (1.0  +  ar**2)/ar) 

part3v  =  (1.0/vhc  -  parhv/ (2 . 0*hhh) )  *3 . 0’'t3 

subeql  =  (el  +  ar*el  +  cosphi  -  1 . 0) *vhc*parhv 

subeq2  =  4 . 0*hhh*el* ( 1 . 0  +  ar) 

subeq3  =  (el  +  ar*el  +  cosphi  -  1.0) **2  +  hhh 

subeq4  =  2 . 0*sqrhhh*vhc 

part4v  =  (subeql  -  subeq2) / (subeq3*subeq4) 

ptffv  =  tl*part2v  +  t2*partlv  +  t3*part4v  +  t4*part3v 

vcopk  =  vhc  +  deltf /ptffv 

vcrpk  =  (vcopk/ (el*sinphi) )* (1.0  -  ar*el  -  (1.0  -  el)*cosphi) 
DO  20  j  =  1,  3 

vc(j)  =  vcrpk*urb(j)  +  vcopk*uthp( j) 
vg(j)  =  vc(j)  -  vinir(j) 
vs(j)  =  vg(j)  -  vdO(j) 

20  CONTINUE 

CALL  spmagt(vs,  mvs,  uvs) 

RETURN 

END 
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A,2.7  Crosst.for 


SUBROUTINE  crosst{vl,  v2,  r) 


c - 

c 

function  : 

takes  the  cross  product  of  two  vectors 

c 

c 

(  vl  X  v2  )  =  r 

c 

inputs  : 

vl,  v2 

c 

c - 

outputs  : 

r 

DOUBLE  PRECISION  vl (3) ,  v2(3),  r(3) 

r(l)  =  vl(2)*v2(3)  -  vl(3)*v2(2) 

r(2)  =  vl(3)*v2(l)  -  vl(l)*v2(3) 

r(3)  =  vl(l)*v2(2)  -  vl(2)*v2(l) 

RETURN 
END 
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A.2.8  Dott.for 

SUBROUTINE  dott(vl,  v2,  r) 

c - 

c  function  :  takes  the  dot  product  of  two  vectors 

c  inputs  :  vl,v2 

c  outputs  :  r 

c - 

IMPLICIT  REAL{a-h,  o-z) 

DIMENSION  vl (3) ,  v2 (3) 

rl  =  vl(l)*v2(l) 

r2  =  vl(2)*v2(2) 

r3  =  vl  (3)  *v2  (3) 

r  =  rl  +  r2  +  r3 

RETURN 

END 
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A.2.9  Fracs.for 


SUBROUTINE  fracs  (t  "ilpc,  dlyc,  sq,  sr,  mdltfr,  malpha,  pm,  tmf, 
&  thf,  lenf) 


c - 

c 

c 

function  : 

models  the  hysteresis  function  employed 
to  generate  the  thruster  commands 

c 

inputs  : 

t, dlpc,  dlyc, sq, sr,mdltfr, malpha, pm 

c 

c - 

both  : 

tmf, thf, lenf 

IMPLICIT  REAL(a-h,  o-z) 

REAL  vcmd(4),  vcmdl{4),  kdtoff 
REAL  kdelta,  tmodtb(4),  kdeltb{4) 

REAL  mdltfr,  malpha,  dtoff(4) 

REALpmO),  tmfdO,  4),  thf(10,  4) 

REAL  tmf  1(10,  4),  thfl(10,  4) 

INTEGER  vcod(4),  vcodl(4),  vlvcmS 
INTEGER  lenf (4) 

DATA  dtfru/0.005/,  tmode2/23 . 01/,  t5/46.0/,  delon/0.045/ 

DATA  deloff/0.035/,  realmn/1 .e-20/,  th jet/370./ 

DATA  tlagfr,  trupfr,  trdnfr/3*0 . 00125/,  vlvcm5/0/,  ikdel/0/ 
DATA  tmodtb/0.00,  22.4,  39.95,  100.0/,  kdeltb/0.4,  0.88,  2.05, 
&  2.05/ 

DATA  kdtoff/1.2/,  bdtoff/0.0/,  vcmd/4*0.0/,  vcod/4*0/,  dtoff/4 

&  *0.0/ 

DO  10  i  =  1,  4 

vcmdl  { i )  =  vcmd { i ) 
vcodKi)  =  vcod{i) 

10  CONTINUE 

CALL  table (tmodtb,  kdeltb,  t  -  tmode2,  kdelta,  4,  ikdel) 

delonp  =  kdelta *delon 

delofp  =  kdelta*deloff 

psense  =  signd.OeO,  dlpc) 

ysense  =  sign(1.0e0,  dlyc) 

IF  (psense  .LT.  0.0)  THEN 

IF  (vcmdl(4)  .GT.  0.5e0)  THEN 
IF  (abs(dlpc)  .LE.  delofp)  THEN 
vcmd ( 4 )  =  0.0 
ELSE 

vcmd ( 4 )  =1.0 
END  IF 

ELSEIF  (abs(dlpc)  .GE.  delonp)  THEN 
vcmd (4)  =  1.0 
ELSE 

vcmd ( 4 )  =  0.0 
ENDIF 

vcmd ( 2 )  =0.0 
ELSE 

IF  (vcmdl (2)  .GT.  0.5)  THEN 
IF  (dlpc  .LE.  delofp)  THEN 
vcmd ( 2 )  =0.0 
ELSE 

vcmd ( 2 )  =  1.0 
ENDIF 

ELSEIF  (dlpc  .GE.  delonp)  THEN 
vcmd ( 2 )  =  1.0 
ELSE 

vcmd ( 2 )  =  0.0 
ENDIF 

vcmd ( 4 )  =0.0 
ENDIF 

IF  (ysense  .LT.  0.0)  THEN 
IF  (vcmdl (1)  .GT.  0.5)  THEN 
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IF  (abs(dlyc)  .LE.  delofp)  THEN 
vcmd ( 1 )  =0.0 
ELSE 

vcmd ( 1 )  =  1.0 
END  IF 

ELSEIF  {abs(dlyc)  .GE.  delonp)  THEN 
vcmd(l)  ^  1.0 
ELSE 

vcmd ( 1 )  =  0.0 
ENDIF 

vcmd ( 3 )  =  0.0 
ELSE 

IF  (vcmdlO)  .GT.  0.5)  THEN 
IF  (dlyc  .LE.  delofp)  THEN 
vcmd (3)  =0.0 
ELSE 

vcmd ( 3 )  =1.0 
ENDIF 

ELSEIF  (dlyc  .GE.  delonp)  THEN 
vcmd ( 3 )  =1.0 
ELSE 

vcmd ( 3 )  =  0.0 
ENDIF 

vcmd { 1 )  =  0.0 
ENDIF 

vlvcmS  =  vlvcmS  +  aint(vcmd{l)  +  vcmd(2)  +  vcmd(3)  +  vcmd(4)) 
DO  30  i  =  1,  4 

IF  (t  .GE.  t5)  THEN 
IF  (i  .EQ.  1)  THEN 

dtlfrc  =  abs (sr) / (mdltfr  -  sqrt (malpha) *abs (sr) ) 
dtoff(l)  =  icdtoff *2 . 0*abs  (dtlfrc)  +  bdtoff 
dtoff(l)  =  aint (dtoff(l) *10000.0) *0.0001 
dtoff(3)  =  dtoff(l) 

ELSEIF  (i  .EQ.  2)  THEN 

dtlfrc  =  abs (sq) / (mdltfr  -  sqrt (malpha) *abs (sq) ) 
dtoff(2)  =  )cdtof f *2. 0*abs  (dtlfrc)  +  bdtoff 
dtoff(2)  =  aint(dtoff(2)*10000.0)*0.0001 
dtoff(4)  =  dtoff(2) 

ENDIF 

ELSEIF  (i  .EQ.  1)  THEN 

temp  =  mdltfr  -  malpha*abs {pm(2) )  +  realmn 

dtlfrc  =  -  sr/temp 

dt2frc  =  sqrt (malpha) * (  -  pm(2))/temp 

dtoff(l)  =  icdtoff*  (abs  (dtlfrc)  +  abs(dt2frc))  +  bdtoff 

dtoff(l)  =  aint(dtoff (1)*10000.0)*0.0001 

dtoff(3)  =  dtoff(l) 

ELSEIF  (i  .EQ.  2)  THEN 

temp  =  mdltfr  -  malpha*abs (pm(3) )  +  realmn 

dtlfrc  =  -  sq/temp 

dt2frc  =  sqrt (malpha) * (  -  pm(3))/temp 

dtoff(2)  =  icdtoff*  (abs  (dtlfrc)  +  abs(dt2frc))  +  bdtoff 

dtoff(2)  =  aint(dtoff (2)*10000.0)*0.000i 

dtoff(4)  =  dtoff(2) 

ENDIF 

DO  20  j  =  1,  10 

tmfl(j,  i)  =  tmf(j,  i) 
thfl ( j,  i)  =  thf  ( j,  i) 
tmf ( j,  i)  =  0.0 
Llif(j,  i)  =  0.0 
20  CONTINUE 

IF  (vcmd(i)  .GT.  0.5)  THEN 
IF  (vcmdl(i)  .GT.  0.5)  THEN 
IF  (vcodl(i)  .EQ.  3)  THEN 
tmf (1,  i)  =  t 
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thf(l,  i)  =  thjet 
iptr  =  2 

ELSEIF  {vcodl(i)  .EQ.  0)  THEN 
trnfd,  i)  =  t 

thf(l,  i)  =  0.0 

tmf{2,  i)  =  t  +  tlagfr 

thf(2,  i)  =  0.0 

tmf{3,  i)  =  tmf(2,  i)  +  trupfr 

thf(3,  i)  =  thjet 

iptr  =  4 

ELSE 

trnfd,  i)  =  tmfldenfd)  -  2,  i) 

thfd,  i)  =  thfldenf(i)  -  2,  i) 

tmf(2,  i)  =  tmfldenf(i)  -  1,  i) 

thf(2,  i)  =  thfldenfd)  -  1,  i) 

tmf(3,  i)  =  tmfl (lenf (i) ,  i) 
thf(3,  i)  =  thfldenf(i),  i) 

IF  (vcodl(i)  .EQ.  2)  THEN 
ttl  -  t  +  tlagfr 
tt2  =  ttl  +  trupfr 
IF  (tmf(3,  i)  .GT.  ttl)  THEN 

tmf{3,  i)  =  {tmf{3,  i)  +  ttl)/2.0 

thf(3,  i)  =  (tmf{3,  i)  -  ttl) *th jet/trdnfr 

tmf(4,  i)  =  tt2 

thf{4,  i)  =  thjet 

iptr  =  5 
ELSE 

tmf(4,  i)  =  ttl 
thf(4,  i)  =  0.0 
tinf(5,  i)  =  tt2 
thf(5,  i)  =  thjet 
iptr  =  6 
END  IF 
ELSE 

tmf(4,  i)  =  t  +  tlagfr 
thf(4,  i)  =  0.0 

tnif(5/  i)  =  tmf(4,  i)  +  trupfr 
thf(5,  i)  =  thjet 
iptr  =  6 
END  IF 

END  IF 

IF  (dtoff(i)  .GE.  dtfru)  THEN 
tmf(iptr,  i)  =  t  +  dtfru 

thf(iptr,  i)  =  thjet 

lenf{i)  =  iptr 

vcodd)  =  3 

ELSEIF  (<dtoff(i)  +  tlagfr)  .GE.  dtfru)  THEN 
tmfdptr,  i)  =  t  +  dtoffd) 
thfdptr,  i)  =  thjet 

tinf(iptr  +  1,  i)  =  tmfdptr,  i)  +  tlagfr 
thfdptr  +  1,  i)  =  thjet 

tmfdptr  +  2,  i)  =  tmfdptr  +  1,  i)  +  trdnfr 
thfdptr  +  2,  i)  =  0.0 
lenf(i)  =  iptr  +  2 
vcod(i)  =  2 

ELSEIF  ((dtoff{i)  +  tlagfr  +  trupfr)  .GE.  dtfru)  THEN 
tmfdptr,  i)  =  t  +  dtoffd)  +  tlagfr 
thfdptr,  i)  =  thjet 

tmfdptr  +  1,  i)  =  tmfdptr,  i)  +  trdr.fr 
thfdptr  +  1,  i)  =  0.0 
lenfd)  =  iptr  +  1 
vcod(i)  =  1 

ELSE 

tmf{iptr,  i)  =  t  +  tlagfr  +  trupfr  +  tlagfr 
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thf(iptr,  i)  =  thjet 

tmfdptr  +  1,  i)  =  tmf(iptr,  i)  +  trdnfr 
thf{iptr  +  1,  i)  =  0.0 
lenf(i)  =  iptr  +  1 
vcod ( i )  =0 
END  IF 
ELSE 

traf(l,  i)  =  t 

thfd,  i)  =  0.0 

tinf(2,  i)  =  t  +  tlagfr 

thf(2,  i)  =  0.0 

tinf(3,  i)  =  tmf(2,  i)  +  trupfr 

thf(3,  i)  =  thjet 

IF  (dtoff(i)  .GE.  dtfru)  THEN 
tmf (4,  i)  =  t  +  dtfru 
thf{4,  i)  =  thjet 
lenf(i)  =  4 
vcod(i)  =  3 

ELSEIF  ((dtoff(i)  +  tlagfr)  .GE.  dtfru)  THEN 
tmf (4,  i)  =  t  +  dtoff(i)  +  tlagfr 
thf{4,  i)  =  thjet 
tmf (5,  i)  =  tmf (4,  i)  +  trdnfr 
thf(5,  i)  =  0,0 
lenf(i)  =  5 

vcodd)  =  2 

ELSEIF  {{dtoff(i)  +  tlagfr  +  trupfr)  .GT.  dtfru)  THEN 
tmf (4,  i)  =  t  +  dtoff(i)  +  tlagfr 
thf{4,  i)  =  thjet 
tmf (5,  i)  =  tmf (4,  i)  +  trdnfr 
thf(5,  i)  =  0.0 
lenf(i)  =  5 
vcod(i)  =  1 
ELSE 

tmf (4,  i)  =  tmf (3/  i)  +  tlagfr 
thf(4,  i)  =  thjet 
tmf (5,  i)  =  t  +  dtfru 
thf(5,  i)  =  0.0 
lenf{i)  =  5 
vcod(i)  =  0 
ENDIF 
END  IF 

ELSEIF  (vcmdl(i)  .GT.  0.5)  THEN 
IF  (vcodl(i)  .EQ.  3)  THEN 
trnfd,  i)  =  t 
thfd,  i)  =  thjet 
tmf  (2,  i)  =  tmfd,  i)  +  tlagfr 
thf(2,  i)  =  thjet 
tmf (3,  i)  =  tmf (2,  i)  +  trdnfr 

thf(3,  i)  =  0.0 

tmf (4,  i)  =  t  +  dtfru 

thf{4,  i)  =  0.0 

lenf(i)  =  4 


ELSEIF  (vcodl(i)  .EQ.  0)  THEN 


tmf (1, 

i) 

= 

t 

thfd. 

i) 

0.0 

tmf (2, 

i) 

= 

t  +  dtfru 

thf (2, 

i) 

= 

0.0 

lenf  (i) 

= 

2 

ELSE 

tmf (1, 

i) 

3= 

tmfl (lenf (i) 

-  2, 

i) 

thfd, 

i) 
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thfl (lenf (i) 

-  2, 

i) 

tmf (2, 

i) 

= 

tmfl (lenf (i) 

-  1, 

i) 

thf (2, 

i) 

= 

thfl (lenf (i) 

-  1, 

i) 

tmf (3, 

i) 

= 

tmfl (lenf (i) , 

i) 
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thf(3,  i)  =  thfl (lenf (i) ,  i) 

tmfU,  i)  =  t  +  dtfru 

thf(4,  i)  =  0.0 

lenf(i)  =  4 

END  IF 

vcod ( i )  =0 
ENDIF 

30  CONTINUE 
RETURN 
END 
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A.2.10  Frcthr.for 


SUBROUTINE  frcthr(t,  eg,  mach,  qa,  tmf,  thf,  lenf,  frex,  frey, 
&  frez,  mrex,  mrcy,  mrez,  mdotf) 


c - 

c 

c 

function  : 

computes  forces  and  moments  resulting  from 
the  forward  reaction  control  thrusters 

c 

inputs  : 

t, eg, mach, qa, tmf, thf, lenf 

c 

c — 

outputs  : 

frex, frey, frez, mrex, mrey, mrez, mdotf 

IMPLICIT  REAL(a-h,  o-z) 

REAL  fredirO,  4),  frcloc(3,  4),  frernaO,  4) 

REAL  f0(3) 

REAL  f ( 3 ) ,  xmom { 3 ) ,  m ( 3 ) 

REAL  mrex,  mrey,  rarez 
REAL  mehlim,  kn 
REAL  km.  Id,  mdotf 
REAL  tmf (10,  4),  thf(10,  4) 

REAL  athrf{4),  knfae 

REAL  kmfae 

REAL  mach,  eg (3) 

INTEGER  indx( 4) ,  lenf(4) 
tinclude  . /include/constant .dat" 

#include  . /include/frcdir .dat" 

#include  . /include/f rcloc.dat" 

finclude  , /include /frema .dat" 

DATA  indx/4*0/,  th jet/370./,  s jet/1. 3273/ 

DATA  djet/1.3/,  fisp/281.3/,  knfac/1.0/,  kmfac/0.0/,  mchlim/4.0/ 
DATA  xjet/-2.71/ 

DATA  xnoz/-12.5.')8;  xnoz2/-7 . 39167/,  slglbm/32 . 174048/ 

IF  (abs(t  -  tstgl)  .LE.  dteps)  xnoz  =  xnoz2 

frex  =  O.OeO 

frey  =  O.OeO 

frez  =  O.OeO 

mrex  =  O.OeO 

mrey  =  O.OeO 

mrez  =  O.OeO 

mdotf  =  O.OeO 

Id  =  (xjet  -  xnoz) /djet 

et  =  thjet/ (qa*s jet) 

IF  (maeh  .LE.  mehlim)  THEN 

kn  =  0.6118  +  (0.1358*{1.  -  0 . 485*sqrt (Id) ) /sqrt (ct) )  +  0.0946 
&  *maeh  +  0.004317/ld 
ELSE 

kn  =  1.0  +  expd.l  -  0.2116*  {log(ct)  +  8.5)**1.4) 

ENDIF 

km  =  0.5582  -  0 . 1884/sqrt (ct)  -  1.9659/ld 
tref  =  t 
DO  20  i  =  1,  4 

IF  (tmf(l,  i)  .GT.  O.OeO)  THEN 

CALL  table  (ernfd,  i) ,  thf(l,  i),  tref,  athrf(i),  lenf(i), 

&  indx ( i ) ) 

ELSE 

athrf(i)  =  O.OeO 
indx(i)  =  0 
ENDIF 

athrf(i)  =  athrf (i) /thjet 
DO  10  j  =  1,  3 

f0(j)  =  frcdir(j,  i) *kn*knfac*th jet*athrf (i) 
xmom(j)  =  cg(j)  -  frcloc(j,  i) 

10  CONTINUE 

f(l)  =  fOd)  *frcma(l,  i)  +  fO  (2)  *frcma  (4,  i)  +  fO  (3)  *f  rema  (7, 

&  i) 
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f(2)  =  fO  (1)  *frcma  (2,  i)  +  fO  (2)  *f  rema  (5,  i)  +  fO  (3)  *frcma  (8, 
&  i) 

f(3)  =  fO  (1)  *f’:cma  (3,  i)  +  fO  (2)  *frcma  (6,  i)  +  fO  (3)  *frcma  (9, 
&  i) 

CALL  spcrosst(f,  xmom,  m) 
frex  =  frex  +  f (1) 
frey  =  frey  +  f (2) 
frez  =  frez  +  f(3) 
mrex  =  mrex  +  m{l) 
mrey  =  mrcy  +  m(2) 
mrez  =  mrez  +  m{3) 

IF  (i  .EQ.  1  .OR.  i  .EQ.  3)  THEN 

mrcy  =  mrcy  +  frcdir(3,  i) *th jet*km*kmfac*djet*athrf (i) 

15  ELSE 

mrez  =  mrez  -  frcdir(2,  i) *th jet*km*kmfac*djet*athrf (i) 

END  IF 

mdotf  =  mdotf  +  th jet*athrf (i) / (fisp*slglbm) 

20  CONTINUE 
RETURN 
END 
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A.2.11  Fv2bxi.for 


SUBROUTINE  fv2bxi(fv,  fvsq,  b) 


c — 

c 

function  : 

compute  direction  cosine  matrix 

(b) 

from 

c 

the  quaternion  attitude  vector 

(fv) 

and 

c 

compute  the  square  (fvsq)  of  the  magnitude 

c 

of  the  quaternion  (fv) 

c 

inputs  : 

fv 

c 

c — 

outputs  : 

fvsq,b 

IMPLICIT  REAL(a-h,  o-z) 
DIMENSION  fv(4),  b(9) 

DATA  rl,  r2/1.0,  2.0/ 

fl  =  fv(l) 

f2  =  fv(2) 

f3  =  fv(3) 

f4  =  fv(4) 

fls  =  fl*fl 

f2s  =  f2*f2 

f3s  =  f3*f3 

f4s  =  f4*f4 

tt  =  fls  +  f2s  +  f3s  +  f4s 


IF  (tt 

.GT.  0)  THEN 

tl  = 

r2/tt 

t2  = 

f3*f4 

t3  = 

fl*f2 

b(2) 

=  tl*(t3 

+ 

t2) 

b(4) 

=  tl*(t3 

- 

t2) 

t2  = 

f2*f4 

t3  = 

fl*f3 

b(7) 

=  tl*(t3 

+ 

t2) 

b(3) 

=  tl*(t3 

- 

t2) 

t2  = 

fl*f4 

t3  = 

f2*f3 

b(6) 

=  tl*(t3 

+ 

t2) 

b(8) 

=  tl*{t3 

- 

t2) 

t2  = 

tl*f4s  - 

rl 

b(l) 

=  tl*fls 

+ 

t2 

b(5) 

=  tl*f2s 

I 

t2 

b(9) 

=  tl*f3s 

+ 

t2 

END  IF 

fvsq  = 

tt 

RETURN 

END 
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A.2.12  Fvdot.for 


SUBROUTINE  fvdot (w,  wd,  f,  fd) 


c - 

c 

function  : 

compute  the 

quaternion  derivatives  (fd) 

c 

using  body 

rates  (w)  and  latent  integral 

c 

derivative 

(wd)  and  the  quaternJon  (f) 

c 

inputs  : 

w,  wd,  f 

c 

c - 

outputs  : 

fd 

IMPLICIT  REAL(a-h,  0-2) 

DIMENSION  w( 3) ,  f(4),  fd(4) 

wl  =  w(l) 

w2  =  w{2) 

w3  =  w(3) 

w4  =  wd 

fl  =  f(l) 

f2  =  f(2) 

f3  =  f(3) 

f4  =  f(4) 

fd(l)  =  (w4*fl  +  wl*:4  -  w2*f3  +  w3*f2)*0.5 

fd(2)  =  (w4*f2  +  wl*f3  +  w2*f4  -  w3*fl)*0.5 

fd(3)  =  (w4*f3  -  wl*f2  +  w2*fl  +  w3*f4)*0.5 

fd(4)  =  (w4*f4  -  wl*fl  -  w2*f2  -  w3*f3)*0.5 

RETURN 
END 
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A.2.13  Gyro.for 


SUBROUTINE  gyro{p,  q,  r,  t,  pulseg) 


c - 

c 

function  : 

gyro  model  computes  sensed  delta  angle 

c 

counts,  includes  axis  misalignment  and 

c 

nonorthogonality  errors,  scale  factor 

c 

errors,  random  and  constant  drift,  and 

c 

quantization . 

c 

inputs  : 

P,q/r,t 

c 

c — 

both  : 

pulseg 

IMPLICIT  REAL{a-h,  0-z) 

REAL  sfwigO),  sflg(3),  sf2g(3),  qfracg(3),  dcg(3) 

REAL  sfeg(3),  wdrg(3),  dthet(3),  pulseg (3) 

INTEGER  gyseed 

DATA  gyseed/123/,  qf racg/3*0 . 0/,  drmeng/0 . 0/,  sppg/0.0/ 

DATA  sflg,  sf2g/6*0.0/,  dcg/3*0.0/,  psig,  thtg,  phig/3*0.0/ 

DATA  thxyg,  thxzg,  thyxg,  thyzg,  thzxg,  thzyg/6*0 . 0/,  drsigg/0.0/ 
#include  " . . /include/constant . dat" 
pmm  =  p  +  q*psig  -  r*thtg 
qmm  =  -  p*psig  +  q  +  r*phig 

rmm  =  p*thtg  -  q*phig  +  r 
pn  =  pmm  +  qmm*thxzg  -  rmm*thxyg 
qn  =  -  pmm*thyzg  f  qmm  +  rmm*thyxg 

rn  =  pmm*thzyg  -  qmm*thzxg  +  rmm 
sfwig(l)  =  sflg(l)*pn  +  sf2g (1) *pn**2 
sfwig(2)  =  sflg(2)*qn  +  sf2g{2) *qn**2 
sfwig(3)  =  sflg(3)*rn  +  sf2g (3) *rn**2 
sfeg(l)  =  pn  +  sfwig(l) 

sfeg(2)  =  qn  +  sfwig(2) 

sfeg(3)  =  rn  +  sfwig(3) 

IF  (t  .GT.  0.0)  THEN 
DO  10  i  =  1,  3 

CALL  norml (drsigg,  drmeng,  gyseed,  drg) 

wdrg(i)  =  drg  +  dcg(i) 

dthet(i)  =  delt* (sfeg (i)  +  wdrg(i)) 

IF  (sppg  .GT.  0.0)  THEN 

qfracg(i)  =  qfracg(i)  -  pulseg  (i)  +  dt)iet  ;i)  /  sppg 
pulseg (i)  =  aint (qfracg (i) ) 

ELSE 

pulseg(i)  =  dthetd) 

END  IF 

10  CONTINUE 
ELSE 

DO  20  i  =  1,  3 
qfracg  (i)  =0.0 
pulseg (i)  =  0.0 
20  CONTINUE 
END  IF 
RETURN 
END 
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A.2.14  Imupro.for 

SUBROUTINE  imupro (pulsea,  pulseg,  delphi,  deltht,  delpsi,  delu, 

&  delv,  delw) 

c - 

c  function  :  computes  the  imu  processor  related  functions 

c  inputs  :  pulsea, pulseg 

c  outputs  :  delUjdelv, delw, delphi, deltht, delpsi 


IMPLICIT  REAL(a-h,  0-z) 

REAL  pulseg (3),  pulsea (3) 

DATA  sfcgx,  sfcgy,  sfcgz,  sfcax,  sfcay,  sfcaz/6*1.0/ 
DATA  phigp/0 . 0/,  thtgp/0.0/,  psigp/0.0/ 

DATA  phiap/0.0/,  thtap/0.0/,  psiap/0.0/ 

DATA  perpg/ 0.0/,  perpa/0.0/ 

DATA  iskull/0/ 

IF  (perpg  .GT.  0.0)  THEN 
delphs  =  pulseg (1) *perpg 
delths  =  pulseg (2) *perpg 
delpss  =  pulseg (3) *perpg 
ELSE 

delphs  =  pulseg (1) 
delths  =  pulseg (2) 
delpss  =  pulseg (3) 

END  IF 

delph  =  delphs*sfcgx 
delth  =  delths*sfcgy 
delps  =  delpss*sfcgz 

delphi  =  delph  -  delth*psigp  +  delps*thtgp 
deltht  =  delph*psigp  +  delth  -  delps*phigp 
delpsi  =  -  delph*thtgp  +  delth*phigp  +  delps 

IF  (perpa  .GT,.  0.0)  THEN 
delus  =  pulsea (1) *perpa 
delvs  =  pulsea (2) *perpa 
delws  =  pulsea (3) *perpa 
ELSE 

delus  =  pulsea (1) 
delvs  =  pulsea (2) 
delws  =  pulsea (3) 

END  IF 

delxs  =  delus *sfcax 
delys  =  delvs *sf cay 
delzs  =  delws*sfcaz 

delum  =  delxs  -  delys*psiap  +  delzs*thtap 
delvm  =  delxs*psiap  +  delys  -  delzs*phiap 
delwm  =  -  delxs*thtap  +  delys*phiap  +  delzs 

IF  (is)cull  .EQ.  0)  THEN 
delu  =  delum 
delv  =  delvm 
delw  =  delwm 
ELSE 

delu  =  delum  -  0 . 5* (delpsi*delvm  -  deltht*delwm) 
delv  =  delvm  -  0 . 5* (delphi*delwm  -  delpsi*delum) 
delw  =  delwm  -  0 . 5* (deltht*delum  -  delphi*delvm) 
END  IF 
RETURN 
END 
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A.2.15  Incorv.for 

SUBROUTINE  incorv(vg,  rmir,  vmir,  mvs,  uvs) 

c - 

c  function  : 

c 

c  inputs  : 

c  outputs  ; 

c  both  : 

c - 

IMPLICIT  DOUBLEPRECISION (a-h,  o-z) 

DOUBLE  PRECISION  rb(3),  vc(3),  vphi(3),  rtpred(3) 

DOUBLE  PRECISION  urb(3),  urt(3),  tmpv(3),  utmpv(3),  uthp{3) 

DOUBLE  PRECISION  vce(3),  vse(3),  rmir{3),  vmir (3) 

DOUBLE  PRECISION  mrb,  mrt,  mtmpv,  mvce,  mvse 
REAL  mvs ,  uvs ( 3 ) ,  vg ( 3 ) ,  vs  <  3 ) ,  vdO ( 3 ) 

DATA  rtpred/21227680,0,  0.0,  1168230.0/,  vpl/13770 . 0/,  ttf/140.0/ 
DATA  fl/450.0/,  f2/-0.5/,  vd0/3*0.0/,  gmu/1 . 4052477el6/ 

DO  10  i  =  1,  3 

vce(i)  =  vg(i)  +  vmir(i) 
vse(i)  =  vg(i)  -  vdO(i) 

10  CONTINUE 

mvse  =  dsqrt (vse (1) **2  +  vse(2)**2  +  vse(3)**2) 

IF  (mvse  .GT.  vpl)  THEN 
scale3  =  vpl/mvse 
ELSE 

scales  =  1.0 
END  IF 

scalar  =  f2*vpl*scale3/f 1 
rb(l)  =  rmir(l)  +  scalar*vse (1) 
rb(2)  =  rmir(2)  +  scalar'-vse  (2) 
rb(3)  =  rmir(3)  +  scalar*vse (3) 

DO  30  ipass  =  1,  50 

CALL  magt(rb,  mrb,  urb) 

CALL  magt(rtpred,  mrt,  urt) 

CALL  crosst(urb,  urt,  tmpv) 

CALL  magt (tmpv,  mtmpv,  utmpv) 

CALL  crosst (utmpv,  urb,  uthp) 

vhc  =  vce(l) *uthp(l)  +  vce (2) *uthp (2)  +  vce (3) *uthp (3) 
vcr  =  vce (1) *urb (1)  +  vce (2) *urb(2)  +  vce (3) *urb (3) 

CALL  crosst (urb,  urt,  vphi) 

sinphi  =  dsqrt (vphi (1) **2  +  vphi(2)**2  +  vphi(3)**2) 

cosphi  =  urb (1) *urt (1)  +  urb (2) *urt (2)  +  urb (3) *urt (3) 

mvce  =  dsqrt (vce (1) **2  +  vce(2)**2  +  vce(3)**2) 

w  =  vhc/mrb 

el  =  mrb*vhc**2/gmu 

ar  =  mrb/mrt 

tpl  =  mvce**2*mrb/gmu 

hhh  =  el*sinphi**2* (2 .0  -  tpl) 

sqrhhh  =  dsqrt (hhh) 

tl  =  el*sinphi/ (hhh*w) 

t2a  =  (1.0  -  el)/ar  +  1.0  -  ar*el 

t2b  =  (2.0*el  -  1.0  -  1 . 0/ar) *cosphi 

t2  =  t2a  +  t2b 

t.^  =  2 . 0*el**2*sinphi**3/ (w*hhh*sqrhhh) 
t4a  =  sqrhhh 

t4b  =  el  +  ar*el  +  cosphi  -  1.0 

t4  =  arctan(t4a,  t4b) 

tffe  =  tl*t2  +  t3*t4 

tff  =  ttf 

deltf  =  tff  -  tffe 

a  =  2.0*  (ar  -  co.-^phi) /sinphi  +  (vcr/vhc) 
b  =  a*vcr  -  vhc 


to  produce  an  initial  estimate  of  correlated 

velocity 

rmir,  vmir 

mvs,  uvs 

vg 
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c  =  b*mrb/gmu 
d  =  c*el*sinphi**2 
e  =  d  +  hhh/vhc 
parhv  =  e*2 . 0 

partlv  =  (1.0/vhc  -  parhv/hhh) *tl 

part2v  =  (2 .0*el/vhc) * (2 .0*cosphi  -  (1.0  +  ar**2)/ar) 

partSv  =  (1.0/vhc  -  parhv/ (2 .0*hhh) ) *3 .0*t3 

subeql  =  (el  +  ar*el  +  cosphi  -  1 . 0) *vhc*parhv 

subeq2  =  4 . 0*hhh*el* ( 1 . 0  +  ar) 

subeq3  =  (el  +  ar*el  +  cosphi  -  1.0) **2  +  hhh 

subeq4  =  2 . 0*sqrhhh*vhc 

part4v  =  (subeql  -  subeq2) / (subeq3*subeq4) 

ptffv  =  tl*part2v  +  t2*partlv  +  t3*part4v  +  t4*part3v 

vcopk  =  vhc  +  de It f /ptffv 

vcrpk  =  (vcopk/ (el*sinphi) )* (1 . 0  -  ar*el  -  (1.0  -  el) *cosphi) 
DO  20  j  =  1,  3 

vc(j)  =  vcrpk*urb(j)  +  vcoDk*uthp ( j ) 

20  CONTINUE 
30  CONTINUE 

DO  40  j  =  1,  3 

vg(j)  =  vc(j)  ■’  vinir(j) 
vs(j)  =  vg(j)  -  vdO(j) 

40  CONTINUE 

CALL  spmagt(vs,  mvs,  uvs) 

RETURN 

END 
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A.2.16  Integ.for 


SUBROUTINE  integi (x,  xdot,  t,  i) 


c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 


function  : 

inputs  : 
outputs  : 

initialize  integral  of  x  which  is  stored 
in  position  i  of  the  integral  array 

X, xdot, t, i 
none 

COMMON  /storag/xint,  tint,  xdotl 
DOUBLE  PRECISION  xint (50),  tint (50), 

xdotl (50) 

DOUBLE  PRECISION  x, 
xint  (i)  =  X 
xdotl (i)  =  xdot 
tint (i)  =  t 

RETURN 

END 

t ,  xdot 

SUBROUTINE  integ(x. 

xdot,  t,  i) 

function  : 

perform,  simple  trapezoidal 

integration  of 

xdot  to  yield  x.  dtd  is  the  time  since 

the  last  integration  and  i 
index  where  x  is  stored 

is  the  array 

inputs  : 

xdot,t, i 

outputs  : 

X 

COMMON  /storag/xint,  tint,  xdotl 

DOUBLE  PRECISION  xint (50) ,  tint (50),  xdotl (50) 

DOUBLE  PRECISION  dt,  dtmp,  x 
DOUBLE  PRECISION  xdot,  t 
dt  =  t  -  tint(i) 

xint(i)  =  xint(i)  +  0 . 5d0*dt* (xdot  +  xdotl (i)) 

X  =  xint  (i) 
tint(i)  =  t 
xdot 1 ( i )  =  xdot 
IF  (i  .EQ.  18)  THEN 

dtrnp  =  dsqrt  (xint  (15)  **2  +  xint(16)**2  +  xint(17)**2  +  xint  (18) 
&  **2) 


xint (15) 
xint (16) 
xint  (17) 
xint (18) 
ENDIF 
RETURN 
END 


xint (15) /dtmp 
xint (16) /dtmp 
xint (17) /dtmp 
xint (18) /dtmp 
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A.2.17  Magt.for 

SUBROUTINE  magt (v,  mv,  uv) 

c - 

c  function  :  computes  the  magnitude  and  unit  vector  of  a 

c  given  vector 

c  inputs  :  v 

c  outputs  :  mv,  uv 

c - 

DOUBLE  PRECISION  mv,  v(3),  uv(3) 

mv  =  dsqrt (v(l) **2  +  v(2)**2  +  v(3)**2) 

IF  (mv  .EQ.  0.0)  THEN 
uv(l)  =  0.0 
uv(2)  =  0.0 
uv(3)  =  0.0 
ELSE 

uv ( 1 )  =  V (1 ) /mv 
uv(2)  =  v(2) /mv 
uv ( 3 )  =  V ( 3 ) /mv 
END  IF 
RETURN 
END 
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A.2.18  Missil.for 


c 

c 

c 

c 

c 

c 

c 

c 


c 


c 


c 


SUBROUTINE  missiKt,  mass,  fxt,  frcx,  fyt,  frcy,  fzt,  frcz,  xyz, 
&  xyzd,  ud,  vd,  wd,  gr,  cim,  xyzdd) 


function  :  computes  the  rotational  and  translational 

missile  accelerations 
inputs  :  t, mass, fxa, fxt, frcx, 

fya,  fyt,  frcy,  fza,  fzt,  frcz,mrcx, 
mrcy,mrcz, xyz,  xyzd 

outputs  :  ud, vd, wd,gr, cim, xyzdd 


IMPLICIT  DOUBLEPRECISION (a-h,  o-z) 

REAL  gr(3) 

DOUBLE  PRECISION  gb(3),  xyzlch(3) 

DOUBLE  PRECISION  xyz (3),  xyzd (3),  uxyz{3) 

DOUBLE  PRECISION  xyzdd (3) 

DOUBLE  PRECISION  mgr,  mxyz 
REAL  mass,  frcx,  frcy,  frcz 
REAL  fxt,  fyt,  fzt,  fxa,  fya,  fza 
REAL  cmi(9),  cim (9),  ud,  vd,  wd 

DATA  nclear/0/,  imis/0/,  rade/20898908 . 0/,  xlnch/3.0/ 
DATA  gmu/1.4052477el6/ 

IF  (imis  .EQ.  0)  THEN 
CALL  sptrans (cim,  cmi) 
xyzlch(l)  =  xlnch*cmi(l)  +  rade 
xyzlch(2)  =  xlnch*cmi{2) 
xyzlch(3)  =  xlnch*cmi(3) 
imis  =  1 
END  IF 

CALL  magtCxyz,  mxyz,  uxyz) 
mgr  =  gmu/mxyz**2 
CALL  mvbys(-mgr,  uxyz,  gr) 
gr(l)  =  -mgr*uxyz(l) 

gr{2)  =  -mgr*uxyz(2) 

gr(3)  =  -mgr*uxyz(3) 

CALL  vecrot (gr,  cim,  gb) 

gb(l)  =  cim(l)*gr(l)  +  cim(4)*gr(2)  +  cim(7)*gr(3) 

gb(2)  =  cim(2)*gr(l)  +  cim(5)*gr(2)  +  cim(8)*gr(3) 

gb(3)  =  cim(3)*gr(l)  +  cim{6)*gr(2)  +  cim(9)*gr(3) 

CALL  receive_real_32bit (fxa) 

CALL  receive_real_32bit (fya) 

CALL  receive_real_32bit (fza) 
fx  =  fxt  +  fxa  +  frcx 

fy  =  fyt  +  fya  +  frcy 

fz  =  fzt  +  fza  +  frcz 

IF  (nclear  .EQ.  1)  THEN 
ud  =  fx/mass  +  gb(l) 
vd  =  fy/mass  +  gb(2) 
wd  =  fz/mass  +  gb(3) 

ELSEIF  (fx/mass  .LE.  dabs(gb(l)))  THEN 
gb(l)  =  0.0 
gb(2)  =  C.O 
gb(3)  =  0.0 

-  call  vecrot (gb, cmi, gr) 

gr(l)  =  cim(l)*gb(l)  +  cim(2)*gb(2)  +  cim(3)*gb(3) 

gr(2)  =  cim(4)*gb(l)  +  cim(5)*gb(2)  +  cim(6;*gb(3) 

gr(3)  =  cim(7)*gb(l)  +  cim(8)*gb(2)  +  cim(9)*gb(3) 

ud  =  0.0 
vd  =  0.0 
wd  =  0.0 
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ELSEIF  (xyz(l)  .LE.  xyzlch(l)  .AND.  xyz(2)  .LE.  xyzlch(2)  .AND. 
&  xyz(3)  .LE.  xyzlchO))  THEN 
gb(2)  =  0.0 

gb(3)  =  0.0 

c -  call  vecrot (gb, cmi,gr) 

gr(l)  =  cim(l)*gb(l)  +  cim(2)*gb(2)  +  cim(3) *gb (3) 

gr(2)  =  cim(4)*gb{l)  +  cim(5)*gb{2)  +  cim(6)*gb(3) 

gr(3)  =  cim(7) *gb (1)  +  cim(8)*gb(2)  +  cim(9)*gb(3) 

ud  =  fx/mass  +  gb(l) 
vd  =  0.0 
wd  =  0.0 
ELSE 

nclear  =  1 
ud  =  fx/mass  +  gb(l) 
vd  =  fy/mass  +  gb(2) 
wd  =  fz/mass  +  gb{3) 

END  IF 

xyzdd(l)  =  cim(l)*ud  +  cim(2)*vd  +  cim(3)*wd 
xyzdd(2)  =  cim(4)*ud  +  cim(5)*vd  +  cim(6)*wd 
xyzdd(3)  =  cim(7)*ud  +  cim(8)*vd  +  cim(9)*wd 
RETURN 
END 
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A.2. 

19  Mmk.for 

SUBROUTINE  mm)c{a, 

na,  b,  nb,  c,  nc,  rm) 

c 

function  : 

generates  a  direction  cosine  matrix 

c 

by  rotating  in  order: 

c 

1)  angle  c  about  the  nc  axis 

c 

2)  angle  b  about  the  nb  axis 

c 

3)  angle  a  about  the  na  axis 

c 

inputs  : 

a,na,b,nb,c,nc 

c 

c — 

outputs  : 

rm 

IMPLICIT  DOUBLEPRECISION (a-h,  o-z) 

DIMENSION  am (3,  3),  bm(3,  3),  cm(3.  3),  rm(3,  3),  t(9) 
CALL  rotmx(a,  na,  am) 

CALL  rotmx(b,  nb,  bm) 

CALL  rotrax(c,  nc,  cm) 

CALL  mmlxy(bm,  cm,  t) 

CALL  mmlxy(am,  t,  rm) 

RETURN 

END 
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A.2.20  Mmixy.for 

SUBROUTINE  mmlxy(x,  y,  z) 

c - 

c  function  :  multiply  two  3x3  matrices 

c  inputs  :  x,  y 

c  outputs  :  z 

c - 

IMPLICIT  DOUBLEPRECISION (a-h,  0-z) 


DIMENSION 

x(3, 

3),  y(3, 

3) 

/ 

Z  (3, 

3) 

z(l. 

1) 

ss 

x(l. 

i)*y(i, 

1) 

+ 

x(l. 

2)*y{2, 

1) 

+ 

x(l. 

3)*y(3, 

1) 

z(2. 

1) 

= 

x(2, 

1) *y(i, 

1) 

+ 

x(2. 

2)*y(2, 

1) 

+ 

x(2. 

3)*y(3, 

1) 

z(3. 

1) 

= 

x(3. 

1) *y(i, 

1) 

+ 

x(3. 

2)*y{2, 

1) 

+ 

x(3. 

3) *y(3, 

1) 

z(l. 

2) 

= 

x(l, 

1) *y(i, 

2) 

+ 

x(l. 

2)*y(2, 

2) 

+ 

x(l. 

3)*y(3, 

2) 

z(2. 

2) 

= 

x{2. 

1)  *y(i, 

2) 

+ 

x(2. 

2)*y(2, 

2) 

+ 

x(2. 

3)*y(3, 

2) 

z(3, 

2) 

= 

x{3. 

1) *y(i, 

2) 

+ 

x(3, 

2)*y(2, 

2) 

+ 

x(3, 

3)*y(3, 

2) 

z(l, 

3) 

= 

x(l, 

1) *y(i, 

3) 

+ 

x(l, 

2)*y(2, 

3) 

+ 

x(l, 

3) *y(3, 

3) 

z(2, 

3) 

= 

x(2, 

1) *y(i, 

3) 

+ 

x(2, 

2)*y(2, 

3) 

+ 

x(2, 

3)*y(3, 

3) 

z  (3, 

3) 

x(3. 

i)*y(i, 

3) 

+ 

x(3. 

2)*y(2, 

3) 

+ 

x(3. 

3)*y(3, 

3) 

RETURN 

END 
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A.2.21  Mvbys.for 

SUBROUTINE  mvbys{a,  b,  c) 

c - 

c  function  :  multiplies  a  vector  by  a  scalar  value 

c  inputs  :  a,  b 

c  outputs  :  c 

c - 

IMPLICIT  DOUBLEPRECISION (a-h,  o-z) 

DIMENSION  b(3) ,  c(3) 
c{l)  =  a*b(l) 
c(2)  =  a*b(2) 
c(3)  =  a*b{3) 

RETURN 

END 


109 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


A.2.22  Navig.for 


SUBROUTINE  navig (delphi,  deltht,  delpsi,  delu,  delv,  delw,  gr,  t, 
&  sq,  sr,  ti2m,  at,  delxd,  delyd,  delzd) 

c - 

c  function  : 

c 
c 
c 
c 
c 

c  inputs  : 

c  outputs  : 

c  both  : 


IMPLICIT  REAL(a-h,  o-z) 

REAL  ti2m(9),  tin2i(9) 

REAL  gr(3) ,  at (3) 

REAL  atg ( 3 ) ,  temp ( 3 ) ,  qs 1 ( 4 ) 

REAL  sq,  sr,  delphi,  deltht,  delpsi,  delu,  delv,  delw 
DATA  mnav/0/,  dtxO/0.0/,  dtyO/0.0/,  dtzO/0.0/ 

DATA  sphiic/0.0/,  sthtic/-35 . 0/,  spsiic/0.0/ 

DATA  dtr/0. 017453292519943296/ 

#include  . /include/constant .dat" 

IF  (mnav  .EQ.  0)  THEN 

sithO  =  sin (sthtic*dtr/2 . 0) 
cothO  =  cos (sthtic*dtr/2 . 0) 
sipsO  =  sin (spsiic*dtr/2 . 0) 
copsO  =  cos (spsiic*dtr/2 . 0) 
siphO  =  sin (sphiic*dtr/2 . 0) 
cophO  =  cos (sphiic*dtr/2 . 0) 

qsl(4)  =  cops0*coth0*coph0  +  sips0*sith0*siph0 

qsl(l)  =  cops0*coth0*siph0  -  sips0*sith0*coph0 

qsl(2)  =  cops0*sith0*coph0  +  sips0*coth0*siph0 

qsl(3)  =  -  cops0*sith0*siph0  +  sips0*coth0*coph0 

END  IF 


computes  the  quaternions  and  transformation 
matrices  using  delta  angles  sensed  by  tiie 
gyro. computes  the  position  and  velocity  in 
inertial  and  earth-centered  frames, 
computes  sensed  body  rates,  euler  angles 
and  the  gravity-compensated  acceleration, 
delphi, deltht, delpsi, delu, delv,  delw,  gr,  t 
ti2m,  at 

sq, sr, vmir, rmir 


dtx  =  0.5e0*delphi 

dty  =  0.5e0*deltht 

dtz  =  0.5e0*delpsi 

ppO  =  dtx**2  +  dty**2  +  dtz**2 

ppl  =  (pp0*dtx  +  dty*dtz0  -  dtz*dty0) /6 . OeO 

pp2  =  (pp0*dty  +  dtz*dtx0  -  dtx*dtz0) /6 . OeO 

pp3  =  (pp0*dtz  +  dtx*dty0  -  dty*dtx0) /6. OeO 

dtxO  =  dtx 

dtyO  =  dty 

dtzO  =  dtz 


dtx  =  dtx  -  ppl 

dty  =  dty  -  pp2 

dtz  =  dtz  -  pp3 

dum  =  -  0.5e0*pp0 

pqO  =  dum*qsl(4)  -  dtx*qsl(l) 

pql  =  dtx*qsl(4)  +  dum*qsl(l) 

pq2  =  dty*qsl{4)  -  dtz*qsl(l) 

pq3  =  dLz*qsl(4)  +  dty*qsl(l) 

qsl  (4)  =  qsl (4)  +  pqO 

qsl(l)  =  qsl(l)  +  pql 

qsl  (2)  =  qsl (2)  +  pq2 

qsl  (3)  =  qsl (3)  +  pq3 


-  dty*qsl (2) 
+  dtz*qsl (2) 
+  dum*qsl (2) 

-  dtx*qsl (2) 


-  dtz*qsl (3) 

-  dty*qsl (3) 
+  dtx*qsl (3) 
+  dum*qsl (3) 


IF  (mnav  .GE.  100)  THEN 

dq  =  0.5e0*(1.0e0  -  qsl(4;**2  -  qsl(l)**2  -  qsl(2)**2  -  qsl{3) 
&  *2) 

qsl(l)  =  qsl (1) * (1 . OeO  +  dq) 
qsl  (2)  =  qsl(2)*(1.0e0  +  dq) 


•k 
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qsl{3)  =  qsl (3) * (1 . OeO  +  dq) 
qsl(4)  =  qslU)*(1.0eO  +  dq) 
mnav  =  1 
ELSE 

mnav  =  mnav  +  1 
ENDIF 

ti2m{l)  =  qsl(4)**2  +  qsl(l)**2  -  qsl{2)**2  -  qsl(3)**2 
ti2m(2)  =  2.0e0*(qsl(l)*qsl(2)  -  qsl (4) *qsl (3) ) 
ti2m{3)  =  2.0e0*(qsl(l)*qsl(3)  +  qsl (4) *qsl (2) ) 
ti2m(4)  =  2.0e0* (qsl (1) *qsl(2)  +  qsl (4) *qsl(3) ) 
ti2m(5)  =  qsl(4)**2  -  qsl{l)**2  +  qsl(2)**2  -  qsl(3)**2 
ti2m(6)  =  2.0e0*(qsl(2) *qsl(3)  -  qsl (4) *qsl(l) ) 
ti2m(7)  =  2.0e0*(qsl(l) *qsl(3)  -  qsl (4) *qsl (2) ) 
ti2m(8)  =  2.0e0*(qsl(2)*qsl(3)  +  qsl (4) *qsl (1) ) 
ti2m{9)  =  qsl(4)**2  -  qsl(l)**2  -  qsl{2)**2  +  qsl(3)**2 
call  trans (ti2m, tm2i) 

IF  (delt  .GT.  0.0)  THEN 
sq  =  deltht/delt 
sr  =  delpsi/delt 
sud  =  delu/delt 

svd  =  delv/delt 

swd  =  delw/delt 

ENDIF 

CALL  vmk{sud,  svd,  swd,  temp) 
call  vecrot (temp,tm21, atg) 

atg(l)  =  ti2m(l) *temp (1)  +  ti2m(2) *temp (2)  +  ti2m{3) *temp (3) 

atg(2)  =  ti2m(4) *temp (1)  +  ti2m(5) *temp (2)  +  ti2m(6) "temp (3) 

atg(3)  =  ti2m(7) *temp (1)  +  ti2m(8) *temp (2)  +  ti2m{9) *temp(3) 

CALL  spvecsub (atg,  gr,  at) 

delxd  =  ti2m(l)*delu  +  ti2m(2)*delv  +  ti2m(3)*delw 

delyd  =  ti2m(4)*delu  +  ti2m(5)*delv  +  ti2m(6)*delw 

delzd  =  ti2m(7)*delu  +  ti2m(8)*delv  +  ti2m(9)*delw 

RETURN 
END 
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A.2.23  Ncu.for 


SUBROUTINE  ncu (dip,  dly,  cmmd,  dlpd,  dlyd) 


function  : 

models  the  response  of  th^  nozzle 
control  unit 

inputs  : 

dip, dly, cmmd 

outputs  : 

dlpd, dlyd 

IMPLICIT  REAL(a-h,  o-z) 

REAL  kncu 
REAL  cmmd (2) 

DATA  kncu/1./,  omegat/66. 66667/,  rmax/1 . 047198/ 
dlpd  =  (cmmd(l)  -  kncu*dlp) *omegat 
dlyd  =  {cmmd(2)  -  kncu*dly) *omegat 
totrat  =  sqrt(dlpd**2  +  dlyd**2) 

IF  (totrat  .GT.  rmax)  THEN 
dlpd  =  dlpd*rmax/totrat 
dlyd  =  dlyd*rmax/totrat 
ENDIF 
RETURN 
END 
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A.2.24  Norml.for 


SUBROUTINE  norml (sd,  mn,  iseed,  rdn) 


c - 

c 

function  : 

generates  normally  distributed  random 

c 

numbers  using  the  bastings  approximation 

c 

inputs  : 

sd,mn 

c 

outputs  : 

rdn 

c 

c - 

both  ; 

iseed 

IMPLICIT  REAL(a-h.  o-z) 

REAL  mn 
REAL  ran 

DATA  cO,  cl,  c2/2. 515517,  0.802853,  0.010328/ 
DATA  dl,  d2,  d3/l. 432788,  0.189269,  0.001308/ 
pul  =  ran (iseed) 

IF  (pul  .EQ.  0.5)  pul  =  ran(iseed) 
pul  =  pul  -  0.5 
pu  =  abs (pul) 

tn  =  sqrt (abs (2 . 0*log(pu) ) ) 

an  =  cO  +  cl*tn  +  c2*(tn**2) 

b  =  1.0  +  dl*tn  +  d2*(tn**2)  +  <i3*  {tn**3) 

xn  =  tn  -  (an/b)  -  l.Oe-5 

IF  (pul  .LT.  0.0)  xn  =  -  xn 

rdn  =  xn*sd  +  mn 

RETURN 

END 
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A.2.25  Qntzr.for 

DOUBLE  PRECISION  FUNCTION  qntzr(a,  b) 

C - - - - - - 

c  function  :  quantize  the  input  variable  b 

c  inputs  :  a,b 

c  outputs  :  qntzr 

c - 

DOUBLE  PRECISION  a,  b 
IF  (a  .GT.  O.OdO)  THEN 

qntzr  =  (dint (b) /a  +  0.5d0)*a 
ELSE 

qntzr  =  b 
ENDIF 
END 
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A.2.26  Ran.for 

REAL  FUNCTION  ran(iseed) 

c - 

c  function  :  random  number 

c  called  from  :  utility  subroutine 

c  subroutines  called  ■  none 

c  inputs  :  iseed 

c  outputs  :  ran 

c - 

iseed  =  69069*iseed  +  1 

ran  =  abs (float (iseed) /2147483647 . 0) 

RETURN- 

END 
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A.2.27  Rotmx.for 

SUBROUTINE  rotrax(x,  i,  xm) 

c - 

c  function  :  generates  a  direction  cosine  matrix 

c  inputs  :  x, 1 

c  outputs  :  xm 

c - 

IMPLICIT  D0L3LEPRECISI0N(a-h,  0-z) 

DOUBLE  PRECISION  xm(3,  3) 

INTEG»:R  i:.t  (3) ,  iiit(3) 

DATA  .Ut/?,  3,  1/,  ii-.t/'3,  1,  2/ 
sx  =  dsin(x 
cx  =  dcos (X) 

ii  =  iit{i) 

iii  =  iiit(i) 

xm(i,  i)  =  1.0 
xm^,  ii)  =  0.0 
xm(i,  iii)  =  0.0 
xm(ii,  i)  =  0..0 
xmUii,  i)  =  0  0 
xm(ii,  ii)  =  cx 
xmiiii,  iii)  =  cx 
xm(ii,  iii)  =  sx 
xmiiii,  ii)  =  -  sx 

RETURN 

END 


116 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


A.2.28  Spcrosst.for 


SUBROUTINE  spcro3St(vl,  v2,  r) 


function  : 

takes  the  cross  product  of  two  vectors 

{  ^  X  ^  )  =  r 

inputs  : 

vl,  v2 

outputs  : 

r 

REAL  vl(3),  v2(3),  r(3) 

r(l)  =  vl(2)*v2{3)  -vl(3)*v2(2) 

r(2)  =  vl(3)*v2{l)  -vl(l)*v2{3) 

r(3)  =vl(l)*v2(2)  -vl(2)*v2(l) 

RETURN 

END 
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A.2.29  Spinteg.for 

SUBROUTINE  spintegi (x,  xdot,  t,  i) 


function  : 

initialize  integral  of  x  which  is  stored 
in  position  i  of  the  integral  array 

inputs  : 

x,xdot,t, i 

outputs  : 

none 

COMMON  /spstorag/xint 

,  tint,  xdotl 

REAL  xint (50) ,  tint (50),  xdotl (50) 

REAL  t,  xdot 

P£AL  X 
xint (i)  =  X 
xdotl (i)  =  xdot 
tint(i)  =  t 

RETURN 

END 

SUBROUTINE  spinteg(x. 

xdot,  t,  i) 

function  : 

perform  simple  trapezoidal  integration  of 
xdot  to  yield  x.  dtd  is  the  time  since 
the  last  integration  and  i  is  the  array 
index  where  x  is  stored 

inputs  : 

xdot , t ,  i 

outputs  : 

X 

COMMON  /spstorag/xint,  tint,  xdotl 
REAL  xint(50),  tint (50),  xdotl (50) 
dt ,  dtmp 


REAL 
REAL 
REAL 
dt  = 


xdot, 

X 

t  -  tint (i) 
xint  (i)  =  xint (i) 

X  =  xint  (i) 
tint(i)  =  t 
xdotl (i)  =  xdot 
IF  (i  .EQ.  18)  THEN 

dtmp  =  sqrt (xint (15) **2 
*2) 


+  0.be0*dt* (xdot  +  xdotl (i)) 


+  xint(16)**2  +  xint(17)**2  +  xint (18) 


xint (15) 
xint (16) 
xint (17) 
xint (18) 
END  IF 
RETURN 
END 


xint (15) /dtmp 
xint (16) /dtmp 
xint (17) /dtmp 
xint (18) /dtmp 
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A.2.30  Spmagt.for 


SUBROUTINE  spraagt(v,  mv,  uv) 


c - 

c 

function  : 

computes  the  magnitude  and  unit  vector  of  a 

c 

given  vector 

r 

inputs  : 

V 

c 

c - 

outputs  : 

mv,  uv 

REAL  mv,  v(3),  uv(3) 
mv  =  sqrt(v(l)**2  +  v(2)**2  +  v(3)**2) 
IF  (mv  .EQ.  0.0)  THEN 
uv(l)  =  0.0 
uv{2)  =  0.0 
'av(3)  =0.0 
ELSE 

uv ( 1 )  =  V ( 1 ) /mv 
uv(2)  =  v(2) /mv 
uv  ( 3 )  =  V ( 3 ) /mv 
ENDIF 
RETURN 
END 
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A.2.31  Spmmk.for 


i'.UBROUTINE  spnimkta,  na,  b,  nb,  c,  nc,  rm) 


c - 

c 

function  ; 

generates  a  direction  cosine  matrix 

c 

by  rotating  in  order: 

c 

1)  angle  c  about  the  nc  axis 

c 

2)  angle  b  about  the  nb  axis 

c 

3)  angle  a  about  the  na  axis 

c 

inputs  : 

a,na,b,nb,c,nc 

c 

c - 

outputs  : 

rm 

IMPLICIT  REAL(a-h,  0-z) 

DIMENSION  am (3,  3),  bm(3,  3),  cm(3,  3),  rm(3,  3),  t(9) 
CALL  sprotmxUr  na,  am) 

CALL  sprotmx(b,  nb,  bm) 

CALL  sprotmx(c,  nc,  cm) 

CALL  spmmlxy(bm,  cm,  t) 

CALL  spmmlxy(am,  t,  rm) 

RETURN 

END 
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A.2.32  Spmmlxy.for 

SUBROUTINE  spitimlxy(x,  y,  z) 


c  function  :  multiply  two  3x3  matrices 

c  inputs  :  x,  y 

c  outpui-s  :  z 

c - 

IMPLICIT  REAL(a-h,  o-z) 


DIMENSION 

x(3, 

3),  y(3, 

3) 

t 

z  (3, 

3) 

z(l, 

1) 

s= 

x(l, 

I)*y(i, 

1) 

+ 

x(l, 

2) *y(2, 

1) 

+ 

x(l, 

3  ‘'y.;3, 

1) 

z  (2, 

1) 

= 

x(2. 

i)*y(i, 

1) 

+ 

x(2, 

2)*y(2, 

1) 

+ 

x(2, 

3)  *y (3, 

1) 

z(3. 

1) 

x(3, 

i)*y(i. 

1) 

+ 

x(3. 

2)*y{2, 

1) 

+ 

x(3. 

3)'i <3, 

1) 

z(l. 

2) 

* 

x(l, 

i)*y(i, 

2) 

+ 

x(l, 

2)*y(2, 

2) 

+ 

x(l, 

3)*y(3, 

2) 

z(2. 

2) 

SS 

x(2, 

i)*y(i, 

2) 

+ 

x(2. 

2)*y(2, 

2) 

+ 

x(2, 

3)*y(3, 

2) 

z  (3, 

2) 

SB 

x(3, 

i)*y(i, 

2) 

+ 

x(3, 

2)*y(2, 

2) 

+ 

x(3, 

3)  *y (3, 

2) 

z(l, 

3) 

SB 

x(l, 

i)*y(i, 

3) 

+ 

x(l, 

2) *y(2, 

3) 

+ 

x(l, 

3)  *y(3, 

3) 

z(2. 

3) 

SC 

x(2, 

i)*y(i, 

3) 

+ 

x(2, 

2) *y(2, 

3) 

+ 

x(2, 

3)  *y(3, 

3) 

z  (3, 

3) 

a: 

x(3. 

1) *y(i, 

3) 

+ 

x(3, 

2) *y(2, 

3) 

+ 

x(3, 

3)  *y(3. 

3) 

RETURN 

END 
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A.2.33  Spmvbys.for 

SUBROUTINE  spmvbys(a,  b,  c) 

c - 

c  function  :  multiplies  a  vector  by  a  scalar  value 

c  inputs  :  a,  b 

c  outputs  :  c 

c - 

IMPLICIT  REAL(a-h,  o-z) 

DIMENSION  b(3) ,  c(3) 
c(l)  =  a*b{l) 
c(2)  «=  a*b(2) 
c(3)  =  a*b(3) 

RETURN 

END 
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A.2.34  Sprotmx.for 

SUBROUTINE  sprotmx(x,  i,  xm) 

- - 

c  function  :  generates  a  direction  cosine  matrix 

c  inputs  :  x, i 

c  outputs  :  xm 

c - 

IMPLICIT  REAL(a-h,  o-z) 

REAL  xm ( 3 ,  3 ) 

INTEGER  iit(3),  iiit(3) 

DATA  iit/2,  3,  1/,  iiit/3,  1,  2/ 
sx  >-=  sin(x) 
cx  ■=  cos  (x) 

ii  =  iit(i) 

iii  =  iiit(i) 

xm(i,  i)  =  1.0 
xm{i,  ii)  =  0.0 
xm(i,  iii)  =  0.0 
xm(ii,  i)  =  0.0 
xm(iii,  i)  =  0.0 
xm(ii,  ii)  =  cx 
xm(iii,  iii)  =  cx 
xm(ii,  iii)  =  sx 
xm(iii,  ii)  =  -  sx 

RETURN 

END 
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A.2.35  Sptrans.for 

SUBROUTINE  sptrans'.a,  b) 

c - 

c  function  :  3x3  matrix  transposition 

c  inputs  :  a 

c  outputs  :  b 

c - 

IMPLICIT  REAL(a-h,  o-z) 

REAL  a(9) ,  b(9) 
b(l)  =  a(l) 
b(2)  =  a(4) 
b(3)  =  a(7) 
b(4)  =  a(2) 
b(5)  =  a(5) 
b(6)  =  a(8) 
b(7)  =  a(3) 
b(8)  =  a(6) 
b(9)  =  a(9) 

RETURN 

END 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


A.2.36  Spvecrot.for 


c 

c 

c 

c 

c 

c 

c 


SUBROUTINE  spvecrot (vin,  rmx,  vout) 


function  :  rotate  a  vector  from  one  coordinate 

frame  to  another  through  rotation 

matrix  rmx. 

inputs  :  vin,  rmx 

outputs  :  vout 


IMPLICIT  REAL(a-h,  o-z) 

REAL  vin (3),  rmx (3,  3),  vout (3) 

vout(l)  =  rmx(l,  l)*vin{l)  +  rmx(l,  2)*vin(2)  +  rmx(l,  '>i*vin(3) 

vout(2)  =  rmx(2,  l)*vin(l)  +  rmx(2,  2)*vin(2)  +  rmx(2,  ..,*vin(3) 

vout(3)  =  rmx(3,  l)*vin(l)  +  rmx(3,  2)*vin(2)  +  rmx{3,  3)*vin(3) 

RETURN 
END 
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A.2.37  Spvecsub.for 


SUBROUTINE  spvecsub(vl,  v2,  r) 


function  : 

subtract  two  3x1  vectors 

(  ^  -  ^  )  =  r 

inputs  : 

vl,  v2 

outputs  : 

r 

IMPLICIT  REAL{a-h, 

o-z) 

REAL  vl (3) ,  v2 (3) , 

r(3) 

r(l)  =  vl(l)  -  v2(l) 

r(2)  =  vl{2)  -  v2{2) 

r(3)  =  vl(3)  -  v2(3) 

RETURN 
END 
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A.2.38  Table.for 

SUBROUTINE  table (xtab,  ytab,  x,  y,  n,  i) 

c - 

c  function  ; 

c 
c 

c  inputs  : 

c  outputs  : 

c  both  : 

c - 

IMPLICIT  REAL(a-h,  o-z) 

INTEGER  n,  i 

REAL  xtab(n),  ytab(n) 

IF  (i  .GE.  1  .AND.  i  .LE.  n)  THEN 

IF  (X  .LE.  xtab(l))  THEN 
y  =  ytab(l) 
i  =  1 

ELSEIF  (X  .GE.  xtab(n))  THEN 
y  =  ytab(n) 
i  =  n 

ELSEIF  (x  .GE.  xtab(i))  THEN 
DO  10  k  =  i,  n  -  1 

"F  (X  .LT.  xtab(k  +  1))  GOTO  20 

10  CONTINUE 

20  fract  =  (x  -  xtab (k) )/ (xtab (k  +  1)  -  xtao(k)) 

y  =  ytab(k)  +  fract* (ytab (k  +  1)  -  ytab(k)) 
i  =  k 

ELSEIF  (X  .LT.  xtab(i))  THEN 
DO  30  k  =  i  -  1,  1,  -1 

IF  (X  .GE.  xtab(k))  GOTO  40 

30  CONTINUE 

40  fract  =  (X  -  xtab (k) )/ (xtab (k  +  1)  -  xtab(k)) 

y  =  ytab(k)  +  fract* (ytab (k  +  1)  -  ytab(k)) 
i  =  k 

END  IF 

ELSEIF  (i  .LT.  1  .OR.  i  .GT.  n)  THEN 

IF  (X  .GT.  xtab(l)  .AND.  x  .LT.  xtab(n))  THEN 
k  =  1 
1  =  n 

DO  50  i  =  k,  1 

IF  (1  .EQ.  k  +  1)  GOTO  60 
m  =  (k  +  l)/2 
IF  (X  .LT.  xtab(in))  THEN 
1  =  m 
ELSE 
k  =  m 
END  IF 

50  CONTINUE 

60  fract  =  (X  -  xtab (k) )/ (xtab (1)  -  xtab(k)) 
y  =  ytab(k)  +  fract* (ytab (1)  -  ytab(k)) 
i  =  k 

ELSEIF  (X  .LE.  xtab(l))  THEN 
y  =  ytab(l) 
i  =  1 

ELSEIF  (X  .GE.  xtab(n))  THEN 
y  =  ytab(n) 
i  =  n 

END  IF 
END  IF 
RETURN 
END 


performs  table  lookup  via  either  indexed 
search  or  binary  search  and  linearly 
interpolates 
xtab, ytab, x,n 

y 

i 
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A.2.39  Tlu2ei.for 


SUBROUTINE  tlu2ei (x,  y,  f,  i,  j,  tbval) 


c - 

c 

function  : 

performs  a  linear  table 

loolc-up 

of  a  table 

c 

with  two  independent  variables, 

and  returns 

c 

indices  pointing  to  the 

area  of 

the  table 

c 

in  use 

c 

inputs  : 

x,y,  f 

c 

c - 

outputs  ; 

i, j, tbval 

IMPLICIT  REAL(a-h,  o-z) 

REAL  f(3) 

EQUIVALENCE  (nl2,  nyu) ,  (n21,  nxl) ,  (n22,  nxu) ,  (nil,  isp) 
EQUIVALENCE  (dx,  xx)  ,  (dy,  yy) 
c  compute  upper  and  lower  bounds  on  indices  for  xx  and  yy 
nxu  “  abs { f ( 1 ) )  +  .1 
mpl  =  abs(f (2) )  +  1.1 
nyu  =  mpl  +  1 
nxl  =  nyu  +  1 
nxu  =  nxu*mpl  +  2 
js  =  j 
is  =  i 

XX  =  X 

yy  =  y 

IF  {.NOT.  ((fd)  .GE.  0.0)  .AND.  (f(2)  .GE.  0.0)))  THEN 
XX  =  y 
yy  =  X 
ENDIF 

IF  (is  .LT.  nxl)  is  =  nxl 
IF  (js  .LT.  3)  js  =  3 
10  CONTINUE 
jsp  =  js  +  1 

IF  (yy  .GT.  f(jsp))  THEN 
IF  (jsp  .EQ.  nyu)  GOTO  30 
js  =  jsp 
GOTO  10 
ENDIF 

20  IF  (yy  .LT.  f(js))  THEN 
IF  (js  .NE.  3)  THEN 
js  =  js  -  1 
GOTO  20 
ENDIF 
ENDIF 

30  CONTINUE 

isp  =  is  +  mpl 
IF  (XX  .GT.  f(isp))  THEN 
IF  (.'isp  .EQ.  nxu)  GOTO  50 
is  =  isp 
GOTO  30 
ENDIF 

40  IF  (XX  .LT.  f(is))  THEN 
IF  (is  .NE,  nxl)  THEN 
is  =  is  -  mpl 
GOTO  40 
ENDIF 
ENDIF 

50  CONTINUE 

nil  =  is  +  js  -  2 

nl2  =  nil  +  1 

n21  =  nil  +  mpl 

n22  =  n21  +  1 

ipmpl  =  is  +  mpl 
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dx  =  (XX  -  f (is) ) / (f (ipmpl)  -  f(is)) 
xj  =  (f(n21)  -  f(nll))*dx  +  f(nll) 
xjpl  =  (f(n22)  -  f(nl2))*dx  +  f(nl2) 
dy  =  (yy  -  f(js))/(f(js  +  1)  -  f(js)) 
j  =  js 
i  =  is 

tbval  =  (xjpl  -  xj)*dy  +  xj 

RETURN 

END 
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A.2.40  Trans.for 

SUBROUTINE  transO,  b) 

c - 

c-  function  :  3x3  matrix  transposition 

c  inputs  :  a 

c  outputs  :  b 

c - 

IMPLICIT  DOUBLEPRECISION (a-h,  o-z) 

DOUBLE  PRECISION  a  (9),  b{9) 

b{l)  =  a(l) 

b(2)  =  a(4) 

b(3)  =  a(7) 

b(4)  =  a(2) 

b(5)  =  a(5) 

b(6)  =  a{8) 

b(7)  =  a(3) 

b{8)  =  a(6) 

b(9)  =  a(9) 

RETURN 

END 
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A.2.41  Vecadd.for 


SUBROUTINE  vecadcKvl,  v2,  r) 


function  : 

add  two  3x1  vectors 

(  ^  +  ^  )  -=7 

inputs  : 

vl,  v2 

outputs  : 

r 

IMPLICIT  DOUBLEPRECISION (a-h,  o-z) 
DOUBLE  PRECISION  vl(3),  v2 (3) ,  r(3) 
r(l)  =  vl(l)  +  v2(l) 

r(2)  =  vl{2)  +  v2<2) 

r (3)  =  vl<3)  +  v2 (3) 

RETURN 

END 
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A.2.42  Vecrot.for 


SUBROUTINE  vecrot (vin,  mix,  vout) 


c — 

c 

function  : 

rotate  a  vector 

from  one 

coordinate 

c 

frame  to  another 

through 

rotation 

c 

matrix  rmx. 

c 

inputs  : 

vin,  rmx 

c 

c — 

outputs  : 

vout 

IMPLICIT  DOUBLEPRECISION ( a -h,  o-z) 

DOUBLE  PRECISION  vin (3),  rmx(3,  3),  vout (3) 

vout(l)  =  rmx(l,  l)*vin(l)  +  rmx(l,  2)*vin(2> 

vout(2)  =  rmx(2,  l)*vin(l)  +  rmx(2,  2)*vin(2) 

vout (3)  =  rmx{3,  l)*vin(l)  +  rmx(3,  2)*vin(2) 

RETURN 
END 


+  rmx(l, 
+  rmx ( 2 , 
+  rmx ( 3 , 


3) *vin (3) 
3) *vin  (3) 
3) *vin  (3) 
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A.2.44  Vmk.for 

SUBROUTINE  vTnk{xl,  x2,  x3,  v) 

c - 

c  function  :  genera" -as  a  vector  from  three  components 

c  inputs  :  xl,  x2,  x3 

c  outputs  :  V 

c - 

IMPLICIT  REAL(a-h,  o-z) 

REAL  v(3) 
v(l)  =  xl 
v(2)  =  x2 
v(3)  «  x3 
RETURN 
END 
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A.2.45  Xferb.for 

SUBROUTINE  xferbO,  i,  b) 

c - 

c  function  :  vector  move 

c  inputs  :  a,i 

c  outputs  :  b 

c - 

IMPLICIT  REAL(a-h,  o-z) 

REAL  a(i),  b(i) 

DO  10  j  =  1,  i 
b(j)  -  a(j) 

10  CONTINUE 
RETURN 
END 
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A.3  Mainlines  (C) 


A.3.1  Aeroca.c 

/*  aeroca.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


♦include  "f2c.h" 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  »  (float) .001; 

static  integer  icaal  =  0; 

static  integer  icam2  =  0; 

static  integer  icaa2  «  0; 

static  real  tfinal  =  (float) 62 . 501; 

static  real  tstgl  =  (float) 23.; 

static  real  calm[205]  =  ( 

(float)  11.,  (float)  16.,  (float)  0.,  (float)  5.,  ( 

float)10., (float)15., (float)20., (float)30., (float)40., (float)60., ( 

float)80., (float)90., (float)lOO., (float)120., (float)140., (float) 

160., (float)170.,  (float)180., (float)O., ( float) -. 166,  (float)- 

.169,  ( 

float)-. 161,  (float)-. 161, (float)-. 15, (float) -. 116, (float)- 

.115,  ( 

float)-. 031, (float)- 

.004, (float) 0., (float) .011, (float) .076, (float) 

.153, (float) .23, (float) .243, (float) .254, (float) .5, (float) - 

.176,  ( 

float)-. 156, (float)-. 15, (float) -. 167, (float) -. 126, (float)- 

.116,  ( 

float)-. 112, (float) -.048, (float) -. 003, (float)O., (float) .007,  ( 

float)  .06,  (float) .142, (float) .229, (float) .238,  (float) .239,  (float) 

.8, (float) -.179, (float) -.196, (float) -.168, (float) -. 162, (float) 
-.152, (float) -.136, (float) -. 103, (float) -. 037, (float)- 
.005, (float) 

0.,  (float) .022,  (float) .082,  (float)  .194,  (float)  .297,  (float)  .32,  ( 
float)  .329,  (float) .9, (float) - .225, (float)-. 21, (float)- 
.219, (float) 

-.228,  (float) -.189, (float) -. 163, ( float) -. 121, (float)- 
.051,  (float) 

.015,  (float)O., (float) .004, (float) .091, (float) .232, (float) .341,  ( 
float) .387, (float) .391, (float) 1.1, (float) -.35, (float) - 
.34, (float) 

-.336,  (float) -.343, (float) -. 315, (float) -.281, (float) - 
.218, (float) 

-.09, (float) - 

.019, (float)O., (float) .015, (float) .132, (float) .31, ( 

float) .482, (float) .522, (float) .52, (float) 1 .2, (float) - 
.334, (float) 

-.351, (float) -.348, (f ioat) - . 328,  (float) -.318,  (float)- 
.276,  (float) 


136 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


-.201/ \tloat) - . 066, (float)- 
.014, (float) 0., (float)  .034,  (float) .169, 

(float) .418, (float) .633, (float) .694, (float) .716, (float) 1.5, (float) 

-.315, (float) -.308, (float) -.309, (float)-. 29,  (float) - 
.28, (float) 

-.244, (float) -.188, (float) -.08,  (float) - 
.007,  (float) 0., (float) .014, 

(float) .156, (float) .381, (float) .564, (float) .631, (float) .646, ( 
float)2., (float) -.267, (float) -.252,  (float) -.284,  (float) -.285,  ( 
float)-. 35,  (float) -.389, (float) -. 433, (float) -. 363, (float)- 

.202,  ( 

float) - 

.11, (float)O., (float) .204, (float) .385, (float) .504, (float) 

.557,  (float)  .582,  (float)4., (float) -. 168, (float) -. 173, (float)- 

.217, 

(float) -.231,  (float.) -.236,  (float) -.298,  (float) -.369,  (float)- 

.455,  ( 

float) -.475, (float) -.471, (float) .359, (float) .125, (float) .31,  ( 
float) .483, (float) .514, (float) .532, (float) 6., (float) - 
.136, (float) 

-.128,  (float) -.178, (float)-. 184, (float) -.224, (float)- 
.267, (float) 

-.342, (float)-. 443, (float)-. 46, (float)- 
.446, (float) .346, (float) 

.045,  (float) .293, (float) .425, (float) .482, (float) .485, (float) 9.,  ( 

float)-. 156, (float) -.136, (float) -. 158, (float)-. 17,  (float)- 

.203,  ( 

float) -.263, (float) -.323, (float) -. 428,  ( float )-. 483,  ( float )- 

.449,  ( 

float) .351, (float) .036, (float) .281, (float) .422, (float) .467, (float) 

.501  }; 

static  real  ca2m[205]  =  ( 

(float) 11 . , (float) 16. , (float) 0 . , (float) 5. ,  ( 

float) 10 . , (float) 15 . , (float) 20 . , (float) 30. , (float) 40 . , (float) 60 . ,  ( 

float)80., (float)90.,  (float)lOO., (float)120., (float)140.,  (float) 

160., (float)i70., (float)l80., (float)O., (f loat) - . 106, (float)- 

.115,  ( 

float)-. 113, (float)-. 1, (float) -.074, (float) -. 077, (float)- 

.053,  ( 

float)-. 019, (float)- 

.005, (float) 0., (float) .019, (float) .046, (float) 

,099,  (float)  .147,  (float)  .169,  (float)  .166,  (float)  .5,  (float) - 

.108,  ( 

float)-. 128, (float) -. 109, (float) -.097,  ( float) -. 078,  (float)- 

.079, ( 

float)  - . 077,  (float) -.013, (float) -.003, (float) 0. ,  (float) .002, ( 

float) .032, (float) .094, (float) .136, (float) .171, (float) .186, (float) 

.8,  (float)-. 122, (float) -.113, (float) -. 119, (float)-. 11,  (float) 
-.099, (float) -.088, (float) -.091, (float)-. 03,  (float)- 
.002, (float) 

0.,  (float)  .019,  (float)  .061, (float) .137, (float)  .203,  (float)  .218,  ( 

float) .222,  (float)  .9, (float) -. 166,  (float) -. 157,  ( float) -. 153,  ( 
float)-. 151,  (float) -. 117, (float) -. 124,  (float) -.109, (float)- 

.034, ( 

fxoat) - 

.011, (float)O., (float) .012, (float) .052, (float) .145, (float) 
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.187,  (float) .242,  (float)  .253,  (float)l.l,  (float) 299, (float)- 

.299 

(float)-. 308, (float) -.294, (float) - .276, (float) -.222, (float)- 

.179,  ( 

float)-  062, (float) - 

.011,  (float) 0., (float) .019, (float) .09,  (float) 

.208,  (float) .332, (float) .361, (float) .363, (float) 1.2, (float) - 

.283,  ( 

float) -.292, (float) -.281, (f loat) - . 259, (f loat) - . 223,  (float) - 

.217,  ( 

float) -.143, (float) -.07, (float) - 
.012,  (float) 0., (float) .001, (float) 

.121, (float) .296, (float) .424, (float) .476, (float) .489, (float) 1.5,  ( 

float)-. 262, (float)-. 242, (float) -.236, (float) -. 237, (float)- 

.197,  ( 

float)-. 176, (float)-. 149, (float) -.056, (float) -.006, (float)O., ( 

float)  .008,  (float)  .099,  (float)  .261,  (float)  .381,  (float)  .41,  (float) 

.451,  (float)2., (float)-. 205,  (float) -. 189, (float) -.225,  (float) 
-.221, (float) -.235, (float) -.229, (float) - .217, (float)- 
.191, (float) 

-.136, (float)- 

.104, (float) .069, (float) .113, (float) .224, (float) .34, 

(float) .374, (float) .387,  (float) 4.,  (float) -. 156,  (float) -. 156,  ( 
float)-. 156,  (float)-. 18,  (float) -.  191,  (float) -. 267,  (f.loat)- 

.329,  ( 

float) -.431, (float) -.474, (float) - 
.457,  (float) .362, (float) .017,  ( 

float)  .191,  (float) .319, (float) .337, (float) .355, (float) 6.,  (float) 

-.108, (float)-. 116, (float)-. 117, (float) -.169, (float)- 

.2, (float) 

-.233, (float)-. 297, (float) -.408, (float)-. 43, (float)- 
.429, (float) 

.326, (float) .022, (float) .197, (float) .309, (float) .326, (float) .343, ( 
float)20., (float)-. 106, (float) -.113, (float) -.127, (float)- 

.163,  ( 

float)-. 192, (float) -.241, (float) -. 305, (float)-. 41, (float)- 

.45,  ( 

float) - 

.435,  (float)  .361,  (float) .012,  (float) .17, (float) .292, (float) 

.341, (float) .338  ); 
static  integer  icaml  =  0; 

static  real  mach,  t,  alfat; 

extern  /*  Subroutine  */  int  receive_net_32 _ (); 

static  real  tstep,  ca; 

extern  /*  Subroutine  */  int  tlu2ei_(),  send_net_32 _ (); 

/*  initialize  time  */ 
tstep  =  (float) 0.; 
t  =  tstep  *  delt; 

LIO: 

receive_net_32 _ (&mach)  ; 

receive_net_32 _ (salfat)  ; 

if  (t  >  tstgl)  { 

/*  second  stage  */ 

tlu2t3i_(&mach,  &alfat,  ca2m,  &icam2,  &icaa2,  &ca)  ; 

)  else  { 

/*  first  stage  */ 

tlu2ei  (&mach,  salfat,  calm,  sicaml,  sicaal,  &ca); 

) 
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send_net_32 _ (&ca) ; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  ( 
goto  LIO; 

) 

)  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main 


{  MAIN  0;  } 
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A.3.2  Aerocn.c 

/*  aerocn.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

#include  "f2c.h" 

/*  Main  program  */  MAIN _ () 

( 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 

static  integer  icnal  =  0; 

static  integer  icnm2  =  0; 

static  integer  icna2  =  0; 

static  real  tfinal  =  (float) 62. 501; 

static  real  tstgl  =  (float) 23.; 

static  real  cnal[205]  =  { 

(float)ll., (float)16., (float)O., (float)5.,  ( 

float)10., (float)15., (float)20., (float)30., (float)40., (float)60.,  ( 

float) 80 . , (float) 90 . ,  (float) 100 . ,  (float) 120 . ,  (float) 140 . ,  (float) 

160., (float)170., (float)180., (float)O., (float)O., (float) .1943,  ( 

float)  .4861,  (float) .6991,  (float) 1 . 031, (f loat)  1 . 8471, (float) 2 . 8683, 

(float) 5.198, (float) 6.7229, (float) 6 . 9385, (float) 6 . 7289, (float) 

5.1903, (float) 2. 8804, (float) .8334, (float) .2054, (float)O., (float) 

.5,  (float)  0.,  (float) .2016, (float) .4596, (float) .7148, (float)  1 .0404, 

(float) 1.8189, (float)2.877, (float) 5 . 1897, (float) 6.7274, (float) 

6.9327, (float) 6.7164, (float) 5 .2139, (float) 2 . 8484, (float) .7949, ( 

float) .2014, (float)O., (float) .8, (float)O., (float) .2108, (float) 
.4888,  (float) .7689, (float) 1 . 1237, (float) 1 . 9773, (float) 3 . 0839, ( 
float) 5.6104, (float)7.2627, (float) 7 . 4829, (float) 7 . 2585, (float) 

5.6183, (floac)3.0957. (float) .8721, (float) .2244, (float)O., (float) 

.9, (float) 0., (float) .2453, (float) .5632, (float) .8506, (float) 1 .2693, 

(float)2.1842, (float) 3 .3373, (float) 6.0308, (float) 7 . 7796, (float) 

8.0298, (float)7.7874, (float) 6.0173, (float) 3 . 3226, (float) .9462, ( 

float)  .2334,  (float)  0.,  (float)  1.1,  (float)  0.,  (float)  .259,  (float) 
.6233, (float) .9733,  (f loat)  1 . 4721,  (float) 2 . 5275,  (float) 3 . 9615, ( 
float)  7.1644, (float)  9.2488,  (float)  9.5353,  (float)  9.2653,  (float) 

7.1618,  (float)  3. 9405,  (float) 1 . 1188, (float) .2778, (float) 0., (float) 

1.2,  (float)O., (float) .249,  (float) .629, (float) .9901, (float)  1.4938, ( 

float)2.7177,  (float)  4.2454,  (float) 7 .7199,  (float)  9 . 9831,  (float) 

10.2965, (floac) 10.0024, (float) 7 . 7086, (float)  4 .2635, (float) 1 .2194,  ( 

float) .3056, (float)O., (float)1.5, (float)O., (float) .2727, (float) 

.625,  (float) 1.0606, (float) 1 . 6051, (float) 2 . 7252,  (float)  4 .2279,  ( 

float)7.6637, (float) 9 . 9322, (float) 10 .2274, (float) 9 . 9171, (float) 
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7.6573, (float) 4.2184, (float) 1 . 1961, (float) .3133, (float)O., (float) 

2.,  (float)O.,  (float) .2753, (float) .6384, (float)  1 . 1354,  (float)  1 . 664, 

(float)2.7542, (float)  3 . 9459, (float) 7 . 1899, (float)  9.2966,  (float) 

9.5868,  (float) 9.2911,  (float) 7 .2048, (float)  3 . 9474, (float) 1 . 129,  ( 

float) .2811, (float)O., (float)4., (float)O., (float) .2656, (float) 
.658, (float) 1.189,  (float)  1.7299, (float) 2 . 6718, (float) 3.7776,  ( 
float) 6.8236, (float) 8 . 8635, (float) 9.1188, (float) 8 . 8535, (float) 

6.8525,  (float)  3.7561,  (float) 1 . 0696, (float) .2716,  (float) 0.,  (float) 

6.,  (float)  0.,  (float)  .2616,  (float)  .6025,  (f loat)  1 . 0334,  (float) 

.4472,  (float)2.522,  (float)  3 . 7044,  (float)  6.7629,  (float) 8 . 7381,  ( 

float) 9.0126, (float) 8.7377, (float) 6.7429, (float) 3 . 7153, (float) 

’..0442,  (float)  .2684,  (float)  0.,  (float)  9.,  (float)  0.,  (float)  .2567,  ( 

float) .615, (float) 1.0322, (float)  1 . 4501, (float) 2 . 5213,  (float) 

3.7166,  (float)  6.7689, (float) 8 . 7283, (float)  9.0069, (float)  8 . 7303, ( 

float) 6.7754, (float) 3 .738, (float) 1 . 0652, (float) .2765, (float) 0. 

}; 

static  real  cna2[205]  =  { 

(float)ll., (float)16., (float)O., (float)5.,  ( 

float) 10. , (float) 15. , (float) 20 . , (float) 30 . , (float) 40 . , (float) 60 . ,  ( 
float) 80 . , (float) 90. , (float) 100 . , (float) 120. , (float) 140 . , (float) 

160.,  (float) 170., (float) 180., (float)O., (float) 0., (float) .1526,  ( 

float) .3299, (float) .5186, (float) .7355, (float) 1.3117, (float) 1.7864, 

(float) 2. 6227,  (float)  3 . 3848, (float) 3.5119, (float)  3 . 3989, (float) 

2.6088,  (float)  1.4323, (float) .4123, (float) .105, (float) 0.,  (float) .5, 

(float) 0., (float) .1466, (float) .324, (float) .5095, (float) .7414, ( 
float)  1.3098,  (float) 1.8016, (float) 2 . 6256,  (float)  3 . 3828,  (float) 
3.5111, (float)3.3918, (float) 2 . 6245, (float) 1 . 437, (float) .4156, ( 
float) .1115, (float)O., (float) .8, (float)O., (float) .1389, (float) 
.3278, (float) .5399,  (float) .7499,  (float) 1 . 4611,  (float) 2 . 0041,  ( 
float)2.8421,  (float) 3 . 6682, (float)  3 . 796, (float) 3 . 6815, (float) 

2.8486, (float) 1.5607, (float) .465, (float) .1158, (float)O.,  (float) .9, 

(float) 0., (float) .1547,  (float) .3536, (float) .5956,  (float) .8675,  ( 

float)1.6577, (float) 2.1614, (float) 3 . 0455, (float) 3 . 9357, (float) 
4.0622, (float) 3. 9195, (float) 3 . 0225,  (float)  1 . 6694, (float) .463,  ( 

float) ,1169, (float)O., (float)l.l, (float)O., (float) .1878, (float) 

.4249,  (float)  .6982, (float) 1 .001,  (float)  1 . 664  9,  (float) 2 . 3611,  ( 
float)3.619, (float) 4.6821, (float) 4 . 8318, (float) 4 . 6926, (float) 

3.6108,  (float) 1.4848, (float) .56, (float) .1396,  (float)O.,  (float)1.2, 

(float) 0.,  (float) .1929, (float) .4189, (float) .6926, (float) 1 . 0156, ( 

float)1.7242, (float) 2 . 5269, (float) 3 . 948, (float) 5 . 0947, (float) 
5,254,  (float) 5.103,  (float) 3 . 9517, (float) 2 . 1728,  (float)  .6054,  ( 

float) .1699,  (float) 0 . ,  (float) 1.5, (float) 0 . ,  (float)  .2014,  (float) 

.412,  (float) .748,  (float) 1.0899, (float)  1 . 7873, (float) 2 . 5183,  (float) 
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3.8838,  (float) 5.0173,  (float)  5 . 1797,  (float) 5 . 0229, (float) 3 . 8697,  ( 

float) 2. 1273,  (float) .612  6,  (float) .173, (float) 0., (float) 2., (float) 

0., (float) .1915, (float) .4388, (float) .7244, (float) 1 . 0354, (float) 

1.751, (float)2.4106, (float) 3 . 6931, (float) 4 . 774, (float) 4 . 9262, ( 
float)  4.7731,  (float)  3.7039,  (float)  2 . 0259, (float) .5808, (float) 

.1458, (float) 0 . , (float) 4 . , (float) 0. , (float) .2038, (float) .4157, ( 

float) .6921, (float) 1.0066, (float) 1 . 6656, (float) 2 . 2891, (float) 

3.4786,  (float)  4.4804,  (float) 4 . 6223,  (float) 4 . 481,  (float) 3 . 4656,  ( 

float) 1.8978, (float) .5393, (float) .1339, (float) 0 . , (float) 6 . , (float) 

0., (float) .1866, (float) .3974, (float) .6419, (float) .9172, (float) 

1.4828,  (floa'-'2.1442,  (float)  3 . 4153,  (float)  4 . 4316,  (float)  4 . 552,  ( 

float) 4.4333, (float) 3 . 4277, (float) 1 . 8834, (float) .5306, (float) 

.1412,  (float) 0., (float) 20.,  (float) 0.,  (float) .1656, (float) .3955,  ( 

float) .6324, (float) .8981, (float) 1 . 4796, (float) 2 . 1259, (float) 

3.4177,  (float)  4.4451, (float) 4 . 5763, (float)  4 . 4204, (float) 3 . 4285,  ( 
float) 1.8721, (float) .5357, (float) .149, (float)O.  }; 
static  integer  icnml  =  0; 

static  real  mach,  t,  alfat,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (),  tlu2ei_(); 

static  real  cn; 

extern  /*  Subroutine  *!  int  send._real_32bit _ (); 

/*  initialize  time  */ 
tstep  «  (float) 0.; 
t  =  tstep  *  delt; 

LIO; 

receive_real_32bit _ (smach)  ; 

receive_real_32bit _ (&alfat)  ; 

if  (t  >~tstgl)  { 

/*  second  stage  */ 

tlu2ei_(&mach,  &alfat,  cna2,  &icnm2,  &icna2,  &cn) ; 

}  eJ  se  { 

/*  first  stage  */ 

tlu2ei_ (Smach,  &alfat,  cnal,  &icnml,  sicnal,  &cn)  ; 

) 

send_real_32bit _ (&cn) ; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

} 

)  /*  MAIN _  */ 

/*  Main  program  alias  *!  int  it(ain_  ()  {  MAIN _  ();  } 
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A.3.3  Aeroxcp.c 

/*  aeroxcp.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


#include  "f2c.h" 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  integer  ixcpal  =  0; 
static  integer  ixcpm2  =0; 
static  integer  ixcpa2  =  0; 
static  real  tfinal  =  (float) 62 .501; 
static  real  tstgl  =  (float) 23.; 
static  real  xcpll[205]  =  { 

(float)  11.,  (float)  16.,  (float)  0.,  (float)  5.,  ( 

float)l0.,  (float)15., {float)20., (float)30., (float)40.,  (float)60.,  ( 
float) 80.,  (float) 90., (float) 100., (float) 120., (float) 140.,  (float) 

160.,  (float)170.,  (float)180.,  (float)O., (float)40.2,  (float)55.6,  ( 

float)  59. 4,  (float) 58. 9,  (float) 59.5, (float) 59.3, (float) 62.3, (float) 

67.1, (float) 78. 8, (float) 85.2, (float) 104.8, (float) 112.6, (float) 

116.8,  (float) 134.4,  (float) 155 . 8, (float) 158.4, (float) .5,  (float) 

42.1, (float)55., (float) 61., (float)57.9, (float) 61.2,  (float) 61.4,  ( 

float)61.2, (float)67.8, (float)78.5, (float)86.1, (float) 106 . 5,  ( 

float) 115.1, (float) 118.3, (float) 132 .2, (float) 156.5,  .oat) 157.8,  ( 

float) .8, (float) 41.1, (float) 59.9, (float) 59.4, (float) 63 . , (float) 

62.,  (float)63.4,  (float)63.5,  (float)71.8, (float)78.2,  (float)88.,  ( 

float) 114.1,  (float) 125.4, (float) 124., (float) 137 . 2, (float) 159.8,  ( 

float)  161.1,  (float)  .  9,  (float)  40.3,  (float)  56.8,  (float)  62.2,  (float) 

63.8, (float) 62.1, (float) 64.4, (float) 65.3, (float) 72. 2,  (float) 78.3,  ( 

float) 84.8, (float) 117.8, (float) 125.8, (float) 127.7, (float) 140.4,  ( 

float)166.9, (float) 175.9, (float)l.l, (float)42.1, (float)58.6,  ( 

float)  60.3,  (float)  63 . ,  (float)  63.5,  (float)  63.8,  (float)  64.5,  (float) 

69., (float) 79. 8, (float) 85.7, (float) 123 . 4, (float) 130 . 3, (float) 

130.9,  (float) 147.6, (float) 188.,  (float) 197.5,  (float) 1.2,  (float) 

43.5,  (float)55.8,  (float) 60.3, (float)63.6, (f’  at) 63.2, (float) 63.3,  ( 
float) 68.3, (float) 74.2, (float) 80.6, (float) 86 . , (float) 127.3, (float) 

131.4, (float) 134., (float) 152 . 3, (float) 189.7, (float) 198 . 3, (float) 

1.5,  (float)43.5, (float)57.6, (float)59.5, (floac)62.3,  (float)61.4,  ( 
float) 66.9,  (float) 72.5,  (float) 76.9, (float) 82.8,  (float) 85.7,  (float) 
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95.2,  (float) 101.9, (float) 105.4, (float) 111.5, (float) 147.6, (float) 

160.2,  (float) 2 . , (float) 46 . , (float) 59.3, (float) 63.7, (float) 65.4, ( 
float)67., (float)73.3, (float)75.4, (float)81.2, (float)82.6, (float) 

86.,  (float)101.6, (float) 104.8, (float) 107 . 8, (float) 109 . 7, (float) 

129.6, (float) 145.7, (float) 4., (float)51.3, (float) 60.2, (float) 68.3, ( 
float)69.9,  (float)72.1, (float)77.9, (float)79.9, (float)80.9, (float) 

84.2,  (float) 86.6,  (float) 113 . 9,  (float) 116.3,  (float) 119.3,  (float) 

121.2,  (float)125.9, (float) 134 . 9, (float)6., (float)52.3, (float)64.2, 

(float) 66.4, (float) 69., (float) 68., (float)74.3, (float)75.5, (float) 

81.9,  (float) 82.5, (float) 86.1, (float) 117 .2, ( float) 120 . 7, (float) 

124.,  (float)  126.6,  (float) 128 . 8, (float) 134 . 4, (float) 9., (float) 50.8, 

(float)  62.6,  (float) 66. 6, (float) 70.1, (float) 68.5, (float) 73.2,  ( 
float)76.6, (float)81.3, (float)83.3, (float)86.4, (float) 117 . 3,  ( 
float) 122.6, (float) 125.2, (float) 126., (float) 129.8, (float) 135.2 

); 

static  real  xcpl2[205]  =  { 

(float)ll., (float)16., (float)O., (float)5.,  ( 

float) 10. , (float) 15 . ,  (float) 20. , (float) 30 . , (float) 40 . , (float) 60 . ,  ( 
float) 80. , (float) SO . , (float) 100 . , (float) 120. , (float) 140 . , (float) 

160.,  (float) 170., (float) 180., (float) 0., (float) 33.5, (float) 35.,  ( 
float)35.3, (float)36.4, (float)36.8, (float)38., (float)37.9, (float) 

42.4,  (float) 45.2, (float) 45. 6, (float) 52. 6, (float) 59., (float) 59. 6, ( 
float) 69.4, (float)79.8, (float)82.9, (float) .5, (float)35.2, (float) 

33.4,  (float)33.3, (float)36.4, (float)35.5, (float)38.4, (float)40.4,  ( 
float;42.9, (float)45.4, (float)47.7, (float)51.4, (float)57.2, (float) 

59.3,  (float) 68.1, (float) 80.7, (float) 80.1, (float) .8, (float) 34.4,  ( 
float) 34.8, (float) 35.1, (float) 36.6, (float) 38.5, (float) 40.3, (float) 

41.4,  (float) 43.5, (float) 46. 6, (float) 47.6, (float) 53.5, (float) 63.1,  ( 
float) 63.5,  (float)  71.1,  (float) 80.8, (float) 83.7, (float) . 9, (float) 

35.7,  (float) 36., (float) 35.1, (float) 35.8, (float) 38.2, (float) 40.9, ( 
float)42.8, (float)44.3, (float)46.7, (float)45.8, (float)53.6, (float) 

65.1,  (float) 67 . , (float) 71.7,  (float) 86.8,  (float) 90.6,  (float) 1.1,  ( 
float)'37.9,  {float)38.G,  (float)3C.4,  {float)37.4,  (float)38.4,  (float) 

41.2,  (float)43.6,  (float)42.8,  (float)43.6,  (float)47.9,  (float)56.7,  ( 
float)  67.4,  (float) 67.6, (float)77., (float) 96.2, (float) 102.6, (float) 
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1.2,  (float)36.7, (float)35.1, (float)36.5, (float)35., (float)40.,  ( 
float) 41.7, (float) 41.1, (float) 43., (float) 46.7, (float) 47.7, (float) 

59.2,  (float)66.5,  (float)67.6, (float)80., (float)97.9, (float) 102 . 7,  ( 
float) 1.5, (float) 34.7, (float) 35.2, (float) 36.7, (float) 39.5, (float) 

40.5,  (float)40.9, (float)41.7, (float)45., (float)45.7, (float)47.5, ( 

float)49.5,  (float)53.5,  (float)55.5,  (.'^loat)  59 . 3,  (float)75.8,  (float) 

82.4, (float)2., (float)35., (float)36.1, (float)37., (float)38.4, ( 

float)40.5,  (float)41., (float)41., (float)44.4, (float)45.5, (float) 

47.6,  (float) 52.6,  (float) 54.3,  (float) 55. 6,  (float) 58.,  (float) 67.3,  ( 
float)76.5, (float)4., (float)33.7, (float)36.4, (float)37.3, (float) 

39.7,  (float)41., (float)43.6, (float)41.5, (float)44.4, (float)45.7, ( 
float) 46.4, (float) 53.8, (float) 60.6, (float) 60.8, (float) 62.8,  (float) 

65.2,  (float)70., (float)6., (float)37.8, (float)56.2, (float)37.6, ( 
float)39.9, (float)39.6, (float)42.2, (float)43.4, (float)43., (float) 

46.9,  (float) 48.7, (float) 54.3, (float) 62.4,  (float) 65.1,  (float) 64.3,  ( 
float) 68.2, (float) 70.5, (float)20. , (float) 35. , (float) 36.1, (float) 

37.9,  (float) 39.5, (float) 40.3, (float) 40.7,  (float) 42.,  (float)  42.5,  ( 

float) 46.8, (float) 48.7, {float)52.8, (float) 62., (float) 64.5, (float) 

65.1, (float) 67.2, (float) 68.8  }; 
static  integer  ixcpml  =  0; 

static  real  mach,  t,  alfat,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (),  tlu2ei_(), 

send_real_32bit _ (); 

static  real  xcp; 

/*  initialize  time  */ 
tstep  =  (float) 0. ; 
t  =  tstep  *  delt; 

LIO: 

receive_real_32bit _ (Smach) ; 

receive_real_32bit _ (Salfat) ; 

if  (t  >  tstgl)  { 

/*  second  stage  */ 

tlu2ei_(&mach,  &alfat,  xcpl2,  &ixcpm2,  &ixcpa2,  &xcp) ; 

)  else  { 

/*  first  stage  */ 

tlu2ei_(&macli,  salfat,  xcpll,  Sixcpml,  &ixcpal,  &xcp)  ; 

} 

xcp  =  - (doublereal) xcp  /  (float) 12.; 

send_real_32bit _ (&xcp) ; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

) 
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}  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  {  MAIN _  () ;  ) 
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A.3.4  Attlm.c 

/*  attlm.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42) . 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*! 

#include  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 5  =  5; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  real  tfinal  =  (f.loat)  62 .501; 
static  real  attltt(5]  =  { 

(float)  0.,  (float) 7.5, (float) 11., (float) 19.25,  ( 
float) 100.  }; 
static  real  attlmt[5]  =  { 

(float) .015, (float) .015, (float) .093, (float) .41, ( 
float). 41  ); 

static  integer  itable  =  0; 
static  real  t; 

extern  /*  Subroutine  */  int  table_(); 
static  real  attlm,  tstep; 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

/*  initialize  time  */ 
tstep  =  (float) 0 . ; 
t  =  tstep  *  delt; 

LIO: 

table_(attltt,  attlmt,  &t,  sattlm,  &c _ 5,  sitable) / 

send_real__32bit _ (sattlm)  ; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

} 

)  /*  MAIN _  */ 

Main  program  alias  */  int  main_  ()  {  MAIN _  () ;  } 
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A.3.5  Bauto.c 

/*  bauto.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


#include  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 59  =  59; 

static  iiiceger  c _ 29  =  29; 

static  integer  c _ 26  =  26; 

static  doublereal  c_b7  =  1.4; 
static  integer  c _ 4  =  4; 

/*  Main  program  *!  MAIN  () 

( 

/*  Initialized  data  */ 

static  real  dele  =  (float) .001; 
static  real  presste[59]  =  { 

(float)2116.25, (float) 1967 . 72, (float) 1827.78,  ( 

float) 1696.02, (float) 1571 . 91, (float) 1455.35, (float) 1345 . 9, (float) 

1243.2, (float)  1147.72, (float) 1057 .49, (float) 973 .289,  (float) 857 .26, 

(float) 752.725, (float) 658.783, (float) 574 . 592, (float) 499.356, ( 

float) 432.644, (float) 374.755, (float) 324 . 623, (float) 281 .21, (float) 

243.614, (float) 203. 13, (float) 166.178, (float) 137.264, (float) 
113.389, (float) 93.7284,  (float)  77 . 5639, (float) 64.2586,  (float) 
53.2944, (float) 44.2494, (float) 37 . 1196, (float) 29.2323, (float) 
23.2726, (float)  18.5578,  (float)  14.8375, (float) 11.912,  (float) 
9.60154, (float)7. 76921,  (float) 6.30961, (float)  5 . 14276, (float) 
4.20625,  (float)  3. 45183,  (float) 2 . 84192, (float)  2 .34714,  (float) 
1.94196, (float)  1.60687,  (float) 1 . 32973, (float) 1 . 10007,  (float) 
.908378, (float) .61551, (float) .413455, (float) .274355, (float) 
.178439, (float) .113488,  (float) .070406,  (float)  .042482,  (float) 
.017169, (float) .002643, (float) .002643  }; 
static  real  vsndte[59]  =  { 

(float) 1116.45, (float)ll08.75, (float) 1100 . 99, ( 

float) 1093.19, (float)  1085.32,  (float)  1077.4, (float)  1069.43,  (float) 

1061.39, (float) 1053.3, (float) 1045.15, (float)  1036.93,  (float) 

1024.48,  (float) 1011.89,  (float)  999 . 14, (float)  98  6.22, (float)  973 . 14,  ( 

float) 968.08, (float) 968.08, (float) 968.08, (float) 968.08, (float) 

968.08, (float) 968.08, (float) 968.08, (float) 968.08, (float) 968.19, ( 

float) 970.9, (float) 973.59, (float) 976.14, (float) 978.95, (float) 

987.62, (float) 984.28, (float) 987 . 59, (float) 990 . 9, (float) 994 . 18, ( 

float) 1002.72, (float) 1011.79, (float) 1020.77, (float) 1029 . 67, (float) 

1038.48, (float) 1047.22, (float) 1055.88, (float) 1064.47, (float) 
1072.99, (float) 1081 .43, (float) 1082 . 02, (float) 1082 . 02, (float) 
1082.02, (float)1078.43, (float) 1072 . 4, (float) 1060 .25, (float) 

1047.98, (float) 1025.62, (float) 1000 . 11, (float) 973 . 96, (float) 947 . 12, 
(float) 919.5, (float)884., (float) 894 . 5, (float)894.5  }; 
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static  real  timtel[26]  =  { 

(float)O., (float) .01, (float) .02, (float) .04,  ( 

float)  .06,  (float)  .08,  (float)  .1,  (float)  .14,  (float)  .2,  (float)  1.,  ( 

float) 2.,  (float) 5.5,  (float)?.,  (float) 12., (float) 16., (float) 18.,  ( 

float)20.,  (float)22.,  (float)23., (float)23.5, (float)23.7, (float) 

23.8,  (float)24., (float)24.4,  (float) 24 . 551,  (float)  24 . 552  }; 
static  real  timte2[29]  =  { 

(float)O., (float) .01, (float) .02, (float) .04, ( 

float)  .06,  (float)  .08,  (float)  .1,  (float)  .14,  (float)  .2,  (float)  1.,  ( 

float)  3 . ,  (float)  5 . ,  (float)  6.5,  (float)  8 . ,  (float)  10 . ,  (float)  12 . ,  ( 

float)15.,  (float)19.5, (float)27., (float)31., (float)33., (float) 

36.5, (float)37.1, (float)37.2, (float)37.5, (float)37.6, (float)37.8, ( 
float) 38.254, (float) 38.255  ); 
static  real  thrtel[26]  =  { 

(float)O., (float) 58.032, (float) 598 . 508, (float) 


2645.385,  (float)  4000 .256,  (float)  4622 .207,  (float) 4939 . 192,  (float) 

5244.599,  (float)  5517 . 307,  (float) 6016 . 711,  (float)  7063 . 661,  (float) 

7903.243, (float)7989.524, (float) 9142.214, (float) 9607.177, (float) 

9737.093, (float) 9393.564, (float) 8788 . 951, (float) 8267 . 048, (float) 

7558.824, (float) 3181 . 193, (float) 1523 . 628, (float) 363 .282, (float) 
18.646, (float) 6.197,  (float) 0.  }  ; 
static  real  thrte2[29]  =  { 

(float)O., (float) 55.723, (float) 551 . 693, (float) 


2156.503, (float)2879.546, (float) 3044 . 879, (float) 3005 . 564, (float) 
2889.39,  (float)  2860.064,  ( float)  2880 . 036, (float)  3319.566,  (float) 
3577.371,  (float) 3532.261,  (float)  3543 . 431, (float)  3589 . 937, (float) 


3641.641, (float) 3864.178, (float) 4045 . 921, (float) 3960 . 807, (float) 
3880.334,  (float)3843.856,  (float)  3599 . 69,  (float) 3395 . 138,  (float) 


2969.519,  (float)  523.301,  (float)  265 . 601,  (float) 70 . 724,  (float) 6 . 019, 
(float) 0.  ) ; 

static  real  tapu  =  (float) 0.; 
static  real  dtapu  =  (float) .005; 
static  real  tapustep  =  (float) 5.; 
static  real  mchlim  =  (float) 4.; 
static  real  tfinal  =  ( float)  62 . 501 ; 
static  real  ]cthtkl  =  (float).  6; 
static  real  )ctht)c2  =  (float)  1.5; 
static  real  tign  =  (float) .01; 
static  real  tst2on  =  (float) 22 . 995; 
static  real  tfrcs  =  (float) 23.; 
static  real  tmode2  =  (float) 23 . 01; 
static  real  wmtvc  =  (float) 25.; 
static  real  zettvc  =  (float). 85; 
static  real  wmfrtt[4]  =  { 

(float)O.,  (float)9.5, (float) 39 . 95, (float)lOO,  ); 
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static  real  wmfrct[4]  =  { 

(float)  62 , 83,  (float) 62.83,  (float) 42., (float) 42  . 

}; 

static  real  tstgl  =  (float) 23.; 
static  real  zetfrc  =  (float). 85; 
static  real  delon  =  (float) .045; 
static  real  bc)clmt  “  (float)  .15; 
static  real  delthg  =  (float). 045; 
static  real  thjet  =  (float) 370.; 
static  real  sjet  »  (float) 1.3273; 
static  real  srefl  «  (float) 1 . 968953; 
static  real  sref2  ■=  (float)  1 . 968953; 
static  real  aexite  »  (float) .305; 
static  real  aexit2  -  (float). 99; 
static  real  tstg2  -  (float) 62.5; 
static  real  xnoze  -  (float) -12. 5583; 
static  real  xnoz2  =  (float) -7 .39167; 
static  real  djet  -  (float) 1.3; 
static  real  xjet  *■  (float) -2 .71; 
static  integer  ialte  =  0; 
static  integer  ithle  =  0; 
static  integer  ith2e  =  0; 
static  integer  iwmfrc  =  0; 

static  real  dtr  -  (float) . 017453292519943296; 
static  real  slglbiti  =  (float)  32. 174048; 
static  real  dteps  =  (float) le-13; 

static  real  frcloc(12]  /*  was  (3] (4]  */  =  {  (float) - 

2.628,  (float) .73, 

(float)O., (float)-2.628, (float)O.,  (float) .73,  (float)- 

2 . 628,  (float) 

-.73,  (float)O.,  (float)-2.628,  (float)O.,  (float)-.-73  ); 
static  real  altte(59]  =  { 

(float)  0. ,  (float)  2e3,  (float)  4e3,  (float)  6e3,  ( 

float)  8e3,  (float)  le4,  (float)  1 .2e4,  (float)  1 . 4e4,  (float)  1 . 6e4,  ( 

float)1.8e4, (float)2e4, (float)2.3e4, (float) 2 . 6e4, (float) 2 . 9e4, ( 

float)3.2e4, (float) 3.5e4, (float) 3.8e4, (float) 4 . Ie4,  (float) 4 . 4e4,  ( 

float) 4 .7e4,  (float)  5e4,  (float) 5 . 4e4, (float) 5 . 8e4, (float) 6 . 2e4,  ( 

float) 6.6e4, (float)7e4,  (float) 7 . 4e4, (float) 7 . 8e4, (float) 8 .2e4,  ( 

float)  8.6e4,  (float)  9e4,  (float)  9.5e4,  (float)  le5,  (float)  1 . 05e5,  ( 

float)  l.le5,  (float) 1.15e5, (float) 1.2e5, (float) 1 .25e5, (float) 1 . 3e5, 

(float) 1.35e5, (float) l,4e5, (float) 1.45e5, (float) 1 . 5e5, (float) 
1.55e5, (float) 1.6e5, (float) 1.65e5, (float) 1 .7e5, (float) 1.75e5, ( 

float) 1 . 8e5,  (float) 1 . 9e5, (float) 2e5, (float) 2 . Ie5, (float) 2 . 2e5,  ( 

float)2.3e5, (float) 2 . 4e5, (float) 2 . 5e5, (float) 2 .75e5, (float)3e5,  ( 
float) 999999.  ); 
static  real  rhote[59i  =  { 

(float)76474., (float) 72098 . , (float) 67917., ( 

float)  63925., (float) 60116., (float)  56483 . ,  (float) 53022 . , (float) 

49725.,  (float)  46589., (float) 43606., (float)  40773 . ,  (float) 36790. ,  ( 

float)33113., (float)29725., (float) 26610 . , (float) 23751 . , (float) 

20794.,  (float) 18012., (float) 15602., (float) 13516., (float) 11709., ( 

float) 9670.1, (float) 7 987., (float) 6597.3, (float) 5448.5, (float) 

4478.7, (float)  3685.8, (float)  3036 . 8,  (float)  2504 . 9,  (float)2068  5,  ( 
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float) 1710., (float) 1350., (float) 1067.6, (float) 845.7, (float) 664.7, ( 

float)524.12, (float) 415.06, (float) 330 . 06, (float) 263 . 53, (float) 
211.22,  (float) 169. 94,  (float)  137 .22,  (float) 111 . 19,  (float)90.4,  ( 
float) 74.713, (float) 61.822, (float) 51 . 159, (float) 42 . 605, (float) 

35.578, (float) 24. 663, (float)  16. 957, (float)  11 . 748,  (float) 8 . 0356,  ( 

float) 5.3888, (float) 3 . 5353, (float) 2 .263, (float) .6171, (float) .1488, 
(float). 1488  ); 

/*  System  generated  locals  */ 
real  r_l,  r_2,  r_3,  r_4; 
double real  d_l; 

/*  Local  variables  */ 

static  real  cmmd[2],  dlpc,  dlyc,  xdel,  xcpe,  thre,  )cpsi,  )ctht; 

extern  doublereal  sparctan_(); 

static  real  vrwm[3],  t; 

extern  /*  Subroutine  */  int  table_(); 

static  real  cnalp,  srefe,  cgest(3],  xcpcg,  )cpsid,  )cthtd,  estqa, 
psier, 

thter,  wmfrc,  thrve,  tstep,  tO; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  Icthfml,  )cthfm2.  Id,  ii[3],  ct,  alfate,  malpha,  sq,  sr, 
Ifracs, 

kthfrc,  estmch,  mdltfr,  totcmd,  icrtfrc,  estalt; 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

static  real  estrho,  estpre,  estvel,  estvsd,  cne,  kme,  kne,  alt; 


/* 

—  */ 

/* 

subroutine 

/* 

/* 

—  */ 

/* 

function  : 

*/ 

/* 

*/ 

/* 

inputs  : 

/* 

outputs  : 

/* 

dlpc, dlyc, mdltfr, malpha)  */ 


provides  control  of  the  missile  about  three 

axes  throughout  the  boost  phase  of  flight 

t,  thter, psier,  sq,  sr,  ii,  cgest,  vrwm,  alt  *•  / 
cmmd, dlpc, dlyc, mdltfr, malpha  */ 


- */ 

/*  initialize  time  */ 
tstep  =  (float) 0 . ; 
t  =  tstep  *  delt; 
cmmd[0]  =  (float) 0.; 
cmmdil]  =  ( float )0.; 
dlpc  =  (float) 0 . ; 
dlyc  =  (float) 0  .  ; 
mdltfr  =  (float) 0  .  ; 
malpha  =  (float) 0.; 
sq  =  (float) 0 . ; 
sr  =  (float) 0 . ; 

LIO: 

send_real_32bit__(cmmd)  ; 

send_real_32bit: _ (&cmmci[l] )  ; 

send_real_32bit _ (&dlpc)  ; 

send_real_32bit _ (&dlyc) ; 

send_real_32bit _ (&sq) ; 
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senci_real_32bit _ (&sr)  ; 

send_real_32bit _ (firndltfr)  ; 

send_real_32bit _ (&malpha)  ; 

receive_real_32bit _ (cgest) ; 

receive_real_32bit _ Ucgest [1] ) ; 

receive_real_32bit _ Ucgest  [2] ) ; 

receive_real_32bit _ (&ii [1] )  ; 

receive _real_32bit _ (salt)  ; 

receive~real_32bit _ (vrwm)  ; 

receive_real_32bit _ (&vrwm[l] ) ; 

receive_real_32bit _ {&vrwm(2i ) ; 

if  (tstep  >“  tapu)  { 
tapu  +=  tapustep; 
if  (t  <  tstg2)  { 

if  ( (r_l  =  t  -  tstgl,  dabs(r_l))  <=  dteps)  ( 
aexite  *  aexit2; 
xnoze  =  xnoz2; 

) 

estalt  =  alt; 

table_(altte,  rhote,  fiestalt,  fiestrho,  &c _ 59,  fiialte) ; 

estrho  =  estrho  *  (float) le-6  /  slglbm; 

table_(altte,  pres:.te,  sestalt,  sestpre,  &c _ 59,  sialte)  ; 

table_(altte,  vsndte,  sestalt,  sestvsd,  &c _ 59,  sialte) ; 

/*  Computing  2nd  power  */ 
r_l  =  vrwm[0]; 

/*  Computing  2nd  power  */ 
r_2  =  vrwm  ( 1  ]  ; 

/*  Computing  2nd  power  */ 
r_3  =  vrwm [2]  ; 

estvel  =  sqrt(r_l  *  r_l  +  r_2  *  r_2  +  r_3  *  r_3) ; 
estmch  =  estvel”/  estvsd; 

/*  Computing  2nd  power  */ 
r_l  =  estvel; 

estqa  =  estrho  *  (r_l  *  r_l)  /  ( float) 2.; 
if  (t  >  tstgl)  { 
srefe  =  sref2; 
to  =  t  -  tst2on; 

table_(timte2,  thrte2,  &t0,  fithrve,  &c _ 29,  &ith2e) ; 

}  else  { 
to  =  t  -  tign; 
srefe  =  srefl; 

table_(timtel,  thrtel,  &t0,  Stlirve,  &c _ 26,  Sithle)  ; 

) 

thre  =  thrve  -  aexite  *  estpre; 
if  (thre  <  (float) 0.)  { 
thre  =  (float) 0.; 

) 

if  (estvel  >  (float) 0.)  { 

/*  Computing  2nd  power  */ 
r_2  =  vrwm  ( 1  ]  ; 

/*  Computing  2nd  power  */ 
r_3  =  vrwm[2]; 

r_l  =  sqrt(r_2  *  r_2  +  r_3  *  r_3) ; 

r_4  =  dabs (vrwmtO] ) ; 

alfate  =  sparctan_(&r__l,  &r_4)  /  dtr; 

)  else  { 

alfate  =  (float) 0.; 

) 

send_real_32bit _ (sestmch)  ; 

send_real_32bit _ (salfate) ; 

/*  if  (  t. It. tstgl  )  then  */ 

/*  call  tlu2ei (estmch, 4 . 0d0,cnale, icnmle, icnale, one) 

*/ 

/*  call  tlu2ei (estmch, alfate, xcplle, icpmle, icpale. 
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xcpe)  */ 

/*  else  */ 

/*  call  tlu2ei (estmch, 4 .OdO, cna2e, icnm2e, lcna2e, cne) 

*/ 

/*  call  tlu2ei (estmch, alfate,xcpl2e, icpm2e, icpa2e, 

xcpe)  */ 

/*  end  if  */ 

receive_real_32bit _ (&cne)  ; 

receive_real_32bit _ (Sxcpe) ; 

/*  conversion  from  inches  to  feet  */ 

xcpe  =  - (doublereal) xcpe  /  (float) 12.; 

/*  calculate  cnalfa  (per  radian)  */ 

cnalp  =  cne  /  (dtr  *  (float) 4.); 
xcpcg  =  xcpe  -  cgest(0]; 

if  (thre  >=  (float) le3  &&  ii[l]  >  (float) le-6)  I 

malpha  =  (r_l  =  cnalp  *  xcpcg  *  srefe  *  estqa  /  ii[l],  dabs  ( 
r_l)); 

} 

receive_real_32bit _ (fipsier) ; 

receive_real_32bit _ (&thter) ; 

receive_real_32bit _ (&sq) ; 

receive_real_32bit _ (&sr)  ; 

/*  tvc  autopilot  */ 

if  (t  <  tmode2)  ( 

if  (thre  >=  (float) le3  &&  ii(13  >  (float) le-6)  { 
xdel  =  cgest(0]  -  xnoze; 

/*  Computing  2nd  power  */ 

r_l  =  wmtvc; 

)ctht  =  (ii[l]  *  (r_l  *  r_l)  +  cnalp  *  srefe  *  estqa  * 
xcpcg)  /  (thre  *  xdel) ; 

/*  Computing  2nd  power  */ 

r_l  =  wmtvc; 

kpsi  =  (ii[l]  *  (r_l  *  r_l)  +  cnalp  *  srefe  *  estqa  * 
xcpcg)  /  (thre  *  xdel) ; 

kthtd  =  zettvc  *  (float) 2.  *  wmtvc  *  ii(l]  /  (thre  * 

xdel) 

/ 

kpsid  =  zettvc  *  (float) 2.  *  wmtvc  *  ii[l]  /  (thre  * 

xdel) 

t 

)  else  { 

ktht  =  (float) 4.; 
kpsi  =  (float) 4.; 
kthtd  =  (float) 4 . ; 
kpsid  =  (float) 4 . ; 

) 

cmmd[0]  =  thter  *  ktht  -  sq  *  kthtd; 
cmmdilj  =  psier  *  kpsi  -  sr  *  kpsid; 

/*  Computing  2nd  power  */ 
r_l  =  cmmd ( 0 ]  ; 

/*  Computing  2nd  power  */ 
r_2  =  cmmd [ 1 ] ; 

totcmd  =  sqrt(r_l  *  r_l  +  r_2  *  r_2); 
if  (totcmd  >  bcklmt)  ( 

cmmd[0]  =  cmmd[0]  *  bcklmt  /  totcmd; 
cmmd[l]  =  cmmdil]  *  bcklmt  /  totcmd; 

} 

)  else  { 

cmmd[0]  =  (float) 0.; 
cmmdil]  =  (float) 0.; 

) 

/*  forward  reaction  control  system  autopilot  */ 
if  (t  >=  tfrcs)  { 

if  (thre  >=  (float)le3  &&  ii[l]  >  (float) le-6)  { 
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Id  =  (xjet  -  xnoze)  /  djet; 
ct  =  thjet  /  (estqa  *  sjet) ; 
if  (estmch  <=  mchlim)  { 

kne  =  {{float)l.  -  sqrt(ld)  (float). 485)  *  (float) 
.1358  /  sqrt(ct)  +  (float). 6118  +  estmch  *  ( 
float) .0946  +  (float) .004317  /  Id; 

)  else  { 

d_l  =  (doublereal)  (log(ct)  +  (float) 8. 5); 

r_l  =  (float)l.l  -  pow_dd(&d_l,  &c_b7)  *  (float) .2116; 

kne  =  exp(r_l)  +  (float) 1.; 

} 

kme  =  (float) .5582  -  (float). 1884  /  sqrt(ct)  -  (float) 
1.9659  /  Id; 

Ifracs  =  frcloc[0]  -  cgest[0]; 

mdltfr  =  (- (doublereal) kme  *  thjet  *  djet  +  kne  *  thjet 

★ 

Ifracs)  /  ii[l]; 
r_l  =  t  -  troode2; 

table_(wmfrtt,  wmfrct,  &r_l,  &wmfrc,  &c _ 4,  &iwmfrc) ; 

/*  Computing  2nd  power  */ 

r_l  =  wmfrc; 

krtfrc  =  zetfrc  *  (float) 2.  *  wmfrc  /  (r_l  *  r_l  + 

malpha) 

kthfrc  =  delon  *  (float) 2.  /  (mdltfr  *  krtfrc  *  dtapu) ; 
kthfml  =  delon  *  malpha  /  mdltfr; 
kthfm2  =  delon  /  delthg; 
if  (kthfrc  <  kthfml)  { 
kthfrc  =  kthfml; 

1 

if  (kthfrc  <  kthfm2)  { 
kthfrc  •-  kthfm2; 

) 

ktht  =  kthfrc  *  kthtkl; 
kthtd  =  ktht  *  krtfrc  *  kthtk2; 
kpsi  =  ktht;' 
kpsid  =  kthtd; 

)  else  { 

malpha  =  (float) 544 . 18; 
mdltfr  =  (float) 6. 0437; 
ktht  =  (float) 10.; 
kthtd  =  (float) 25.; 
kpsi  =  (float) 10 . ; 
kpsid  =  (float) 25.; 

1 

dlpc  =  thter  *  ktht  -  sq  *  kthtd; 
dlyc  =  psier  *  kpsi  -  sr  *  kpsid; 

) 

}  else  { 

send_real_32bit _ (fiestmch) ; 

send_real_32bit _ (salfate) ; 

receive_real_32bit _ (&cne) ; 

receive_real_32bit _ (&xcpe) ; 

receive_real_32bit _ (Spsier) ; 

receive_real_32bit _ (Sthter)  ; 

receive_real_32bit _ (&sq) ; 

receive_real_32bit _ (&sr)  ; 

) 

)  else  { 

send_real_32bit _ (sestmch) ; 

send_real_32bit _ (salfate) ; 

receive_real_32bit _ (&cne) ; 

receive_real_32bit _ (Sxcpe) ; 
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receive_real_32bit _ (spsier) ; 

receive_real_32bit _ (fithter)  ; 

receive_real_32bit _ (&sq) ; 

receive_real_32bit _ (&sr)  ; 

} 

/*  Increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

) 

}  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  {  MAIN _  ();  ) 
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A.3.6  Boost2a.c 

/*  boost2a.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

V 

♦include  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 1  =  1; 

static  integer  c _ 2  =  2; 

static  integer  c _ 3  =  3; 

static  integer  c _ 5  =  5; 

static  integer  c _ 6  =  6; 

static  integer  c _ 7  =  7; 

static  integer  c _ 8  =  8; 

static  integer  c _ 9  =  9; 

static  integer  c _ 10  =  10; 

static  integer  c _ 11  =  11; 

static  real  c_bl5  =  (float) 0.; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  doublereal  delt  =  .001; 

static  doublereal  slglbm  =  32.174048; 

static  real  massO  =  (float) 43 . 939; 

static  real  wkvO  =  (float) 97.1; 

static  doublereal  latlp  =0.; 

static  doublereal  longlp  =  0.; 

static  doublereal  tfinal  =  62.501; 

static  doublereal  tstgl  =  23.; 

static  doublereal  tstg2  =  62.5; 

static  doublereal  dteps  =  le-13A 

static  doublereal  rade  =  20898908.; 

static  real  msstg2  =  (float) 19. 457; 

static  doublereal  dtr  =  .017453292519943296; 

/*  System  generated  locals  */ 
doublereal  d_l,  d_2,  d_3; 

/*  Local  variables  */ 

static  real  frcx,  mass,  frcy,  frcz,  mdot; 

static  doublereal  xyzd[3],  xyze[3]; 

extern  /*  Subroutine  */  int  spintegi_(); 

static  integer  i; 

static  doublereal  t; 

extern  /*  Subroutine  */  int  integ_() ; 

static  real  mdotf,  mdott; 

static  doublereal  tstep,  xyzdd[3],  xyzed[3]; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  gr[3],  ud,  vd,  wd; 

extern  /*  Subroutine  */  int  integi_(),  send_real_32bit _ (), 

missil_() , 

vecrot_ ( ) ,  send_real _64bit _ ( ) ; 

static  integer  mdotkv; 
static  doublereal  xyzedd(3]; 
static  real  wdotkv; 
static  doublereal  cei[9]; 
static  real  cim[9],  alt; 
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extern  /*  Subroutine  */  int  mmk_() ; 
static  real  fxt,  fyt,  fzt,  spt,  wkv,  massold; 
extern  /*  Subroutine  */  int  spinteg_(); 
static  doublereal  xyz[3]; 
static  real  tmp_xyz _ [3]; 

/*  initialize  time  */ 
tstep  =  (float) 0. ; 
t  =  tstep  *  delt; 
for  (i  =  1;  i  <=  3;  ++i)  { 
xyze(i  -  1]  =  ( float )0.; 
xyzed[i  -  1]  =  (float) 0.; 
xyzedd(i  -  1]  =  (float) 0.; 

/*  LIO:  */ 

} 

xyze[0]  =  rade; 

/*  Computing  2nd  power  */ 
d_l  =  xyze[0]; 

/*  Computing  2nd  power  */ 
d_2  =  xyze [ 1 ] ; 

/*  Computing  2nd  power  */ 
d_3  =  xyze [2]; 

alt  =  sqrt (d_l  *  d_l  +  d_2  *  d_2  +  d_3  *  d_3)  -  rade; 

/* 


- c  */ 

/*  -  missile  state  initialization  module 

- c  */ 

/* 


- c  */ 

/*  initialize  states  and  state  derivatives  */ 
mass  =  massO; 
w)cv  =  w]cv0; 

d_l  =  dtr  *  (float) -90.; 
d_2  =  latlp  *  dtr; 
d_3  =  longlp  *  dtr; 

mmJc_(&d_l,  &c _ 1,  &d_2,  &c _ 2,  &d_3,  &c _ 3,  cei)  ; 

vecrot_(xyzed,  cei,  xyzd) ; 
vecrot_(xyze,  cei,  xyz); 
mdot  =  (float) 0.; 
wdotkv  =  (float) 0.; 
vecrot_(xyzedd,  cei,  xyzdd) ; 
spt  =  t; 

spintegi_(&mass,  &mdot,  &spt,  &c _ 1) ; 

spintegi_(&wkv,  swdotkv,  &spt,  &c _ 5) ; 

integi_(xyzd,  xyzdd,  &t,  &c _ 6); 

integi_(&xyzd(l] ,  Sxyzdd(l],  &t,  &c 7); 

integi_(&xyzd(2] ,  &xyzdd[2i,  &t,  &c 8); 

integi_(xyz,  xyzd,  &t,  &c _ 9) ; 

integi_(&xyz [1] ,  &xyzd[l],  &t,  &c _ 10); 

integi_(&xyz [2] ,  &xyzdi2],  &t,  &c _ 11); 


- */ 

/*  initialize  processor  inputs  if  not  already  initialized  */ 


pi  */ 
fxt  = 

(float) 0 . ; 

fyt  - 

(float) 0 . ; 

fzt  = 

(float) 0 .  ; 

mdott 

=  (float) 0. 

frcx  = 

(float) 0. ; 

frcy  = 

(float) 0.  ; 

frcz  = 

(float) 0 . ; 
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mdotf  =  (float) 0.; 

/*  p2  */ 

/*  p3  */ 

ud  =  (float) 0 . ; 
vd  =  (float) 0 . ; 
wd  =  (float) 0 . ; 

/*  p4  */ 

for  (i  =  1;  i  <=  3;  ++i)  ( 
gr[i  -  1]  =  (float) 0.; 

/*  L20:  */ 

) 

/*  p5  */ 

/*  initialization  routine  */ 
mass  +=  delt  *  mdot; 

/* 


- c  */ 

/* - main  execution  loop 

- c  */ 

/* 


- c  */ 

L30: 

/* 

V 

/*  -k  -k  ! 

/*  partition  1  *  */ 

/*  *  */ 

/* 

*/ 

/*  -  missile  state  update  module 

- c  */ 

/*  temporarily  extrapolate  missile  states  from  last  integration  */ 

/*  step  (  note  :  the  extrapolated  states  are  overwritten  when  */ 

/*  the  true  integration  is  performed  )  */ 

/* - send  parameters  to  partitions  3,  4,  and  5 

- c  */ 


send_real_32bit _ (&ud)  ; 

send_real_32bit _ (&vd)  ; 

send_real_32bit _ (&wd) ; 

send_real_32bit _ (gr) ; 

send_real_32bit _ Ugr  [1] )  ; 

send_real_32bit _ (&gr [2] ) ; 

send_real_32bit _ (salt) ; 

/*  -  send  mass  to  masspr  subroutine  table  lookup  processors 

- c  */ 

send_real_32bit _ (&mass) ; 

xyzd[0]  +=  delt  *  xyzddiO]; 

xyzdil]  +=  delt  *  xyzdd[l]; 

xyzd[2]  +=  delt  *  xyzdd(2]; 

xyz[0]  +=  delt  *  xyzd[0]; 

xyz[l]  +=  delt  *  xyzd[l]; 

xyz[2]  +=  delt  *  xyzd[2]; 

/*  calculate  current  missile  altitude  */ 

/*  Computing  2nd  power  */ 
d_l  =  xyz [ 0 ] ; 

/*  Computing  2nd  power  */ 
d_2  =  xyz [ 1 ] ; 

/*  Computing  2nd  power  */ 
d_3  =  xyz[2]; 

alt  =  sqrt(d_l  *  d_l  +  d_2  *  d_2  +  d_3  *  d_3)  -  rade; 

/*  -  send  altitude  to  atmos  subroutine  table  lookup  processors 
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-c  */ 

send_real_32bit _ (Salt)  ; 

/* - ""send  parameters  to  thread  containing  winds  subroutine 

- c  */ 

send_real_64bit _ (xyz)  ; 

send_real_64bit _ (&xyz[l]) ; 

send_real_64bit _ (&xyz  (2] )  ; 

send_real_64bit _ (xyzd) ; 

send_real_  (iibit _ '.&xyzd[l] )  ; 

send_real”64bit _ (&xyzd[2] ) ; 

receive_real_32bit _ (cim)  ; 

receive_real_32bit _ (&cim[l] )  ; 

receive_real_32bit _ (&cimC2] )  ; 

receive_real_32bit _ (&cim[3i )  ; 

receive_real_32bit _ (&cim[4] ) ; 

receive_reai_32bit _ (&cim[5] )  ; 

receive_real_32bit _ (Scim[6] ) ; 

receive_real_32bit _ {&cim[7] ) ; 

receive_real_32bit _ (&cim[8] ) ; 

/*  -  receive  parameters  from  partition  #2 

- c  */ 

receive_real_32bit _ (&fxt) ; 

receive_real_32bit _ (&fyt) ; 

receive_real_32bit _ (&fzt) ; 

receive_real_32bit _ (&frcx) ; 

receive_real_32bit _ (&frcy) ; 

receive_real_32bit _ (Sfrcz) ; 

receive_real_32bit _ (&mdott) ; 

receive_real_32bit _ (fimdotf) ; 

wkv  +=  delt  *  wdotkv; 

mdotkv  =  (integer)  (- (doublereal)mdotf  *  slglbm) ; 
mdot  “  - (doublereal)mdott  -  mdotf; 

/*  save  mass  value  for  use  in  raissil  subroutine  */ 
massold  =  mass; 
spt  =  t; 

/*  trapezoidal  integration  for  simplicity  */ 
if  ( (d_l  =  t  -  tstgl,  abs(d_l))  <=  dteps)  { 

/*  first  stage  separation  */ 
mass  =  msstg2; 

spintegi_(&mass,  &c_bl5,  &spt,  &c _ 1) ; 

}  else  if  ( (d_l  =  t  -  tstg2,  abs(d_l))  <=  dteps)  { 

/*  second  stage  separation  */ 
mass  =  wkv  /  slglbm; 

spintegi_(&mass,  &c_bl5,  &spt,  &c _ 1) ; 

}  else  { 

spinteg_(&mass,  &mdot,  &spt,  &c _ 1) ; 

) 

wkv  =  dmax(wkv, (float) 0.); 

spinteg_(&wkv,  & wdotkv,  &spt,  &c _ 5) ; 

mass  +=  delt  *  mdot; 

/*  -  vehicle  states  module 

- c  */ 

missil_(&t,  smassold,  &fxt,  &frcx,  &fyt,  &frcy,  &fzt,  Sfrcz,  xyz, 
xyzd,  & 

ud,  &vd,  &wd,  gr,  cim,  xyzdd) ; 

/* 


- c  */ 

/*  missile  state  integration  module 

c 
*/ 

/* 


c  */ 
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integ_(xyzd,  xyzdd,  &t,  &c _ 6); 

integ_(&xyzd[l] ,  &xyzddtl],  &t,  &c 7); 

integ_(Sxyzd[2] ,  &xyzdd[2],  &t,  &c 8); 

integ_(xyz,  xyzd,  &t,  &c _ 9) ; 

integ_Uxyz  [1] ,  &xyzd[l],  &t,  &c _ 10); 

integ_(&xyz [2] ,  &xyzdi2],  &t,  &c _ 11); 

/*  calculate  current  missile  altitude  */ 

/*  Computing  2nd  power  */ 
d_l  =  xyz(0]; 

/*  Computing  2nd  power  */ 
d_2  =  xyz [ 1 ] ; 

/*  Computing  2nd  power  */ 
d_3  -  xyz [2]; 

alt  *  sqrt (d_l  *  d_l  +  d_2  *  d_2  +  d_3  *  d_ 

tmp_xyz _ [ 0 ]  =  xy z [ 0 ] ; 

tmp_xyz _ [ 1 ]  =  xyz [ 1 ] ; 

tmp_xyz _ [ 2 ]  =  xy z [ 2 ] ; 

send_real_32bit _ (tmp_xyz _ )  ; 

send_real_32bit _ (&tmp_xyz _ [1] )  ; 

send_real_32bit _ (stmp_xyz _ [2] )  ; 

send_real_32bit  (&alt) ; 

/* 

*/ 

/* 

/*  end  of  partition  1 

*  -k ! 

/* 

/* 

kk'kkkkkit'kitkkk'kifk'k'k'kitk'k-kkk'k'kit'kk'kifkk'kifkitit-kiikitk'kkk 


I*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  L30; 

1 

)  /*  MAIN  */ 


3 )  -  rade ; 

ii-k'kifkiKk'k'k-kkkitifk-k'kifk'k'k-kk'k 

*  k ! 

*  k  j 


/*  Main  program  alias  */  int  main_  ()  {  MAIN _  ();  } 
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A.3.7  Boost2al.c 

/*  boost2al.f  —  translated  by  f2c  (version  of  3  February  1990 
3:36:42) . 

You  must  link  the  resulting  object  file  with  the  libraries: 
-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

tinclude  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 1  =  1; 

static  integer  c _ 2  =  2; 

static  integer  c _ 3  =  3; 

static  doublereal  c_b6  =  0 . ; 

/*  Main  program  */  MAIN_() 

{ 

/*  Initialized  data  */ 

static  doublereal  delt  =  .001; 

static  doublereal  sref2  =  1.968953; 

static  doublereal  latlp  =  0.; 

static  doublereal  longlp  =  0.; 

static  doublereal  tmpl  =  0.; 

static  doublereal  tfinal  =  62.501; 

static  doublereal  tstgl  =  23.; 

static  doublereal  tstg2  ■-  62.5; 

static  doublereal  omegae  -  0.; 

static  doublereal  dtr’=  .0174532925199-.3296; 

static  doublereal  srefl  =  1.968953; 

/*  System  generated  locals  ■*/ 
real  r_l,  r_2,  r_3; 
doublereal  d_l,  d_2,  d_3; 

/*  Local  variables  */ 
static  real  mach,  long_,  vsnd; 
static  doublereal  vrwi[3]; 
static  real  vrwm[3]; 

static  doublereal  xyzd[3],  xyze(3],  xyzr[3]; 

static  real  rhod2; 

static  doublereal  a,  b,  c,  d; 

static  integer  i; 

static  doublereal  t,  cphia; 

static  real  alfat,  shear; 

static  doublereal  sphia; 

static  real  cwdir,  vwind,  swdir; 

extern  /*  Subroutine  */  int  trans_(); 

static  doublereal  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (),  mmlxy_() ; 

static  doublereal  mvrwm; 

extern  /*  Subroutine  */  int  receive_real_64bit _ (); 

static  real  ca,  cn,  qa; 
static  doublereal  qs; 
extern  doublerear  arctan_(); 

extern  /*  Subroutine  */  int  vecsub_(),  send  real  32bit _ (); 

static  doublereal  viwind[3]; 

extern  /*  Subroutine  */  int  vecrot_() ; 

static  doublereal  vrwind[3],  vwwind(3],  cie(9],  cei(9]; 

static  real  cim[9]; 

static  doublereal  cer[9j,  cir[9],  criC9]; 
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static  real  fxa,  fya,  fza,  lat; 

extern  /*  Subroutine  */  int  mmk_(); 

static  doublereal  cwr[9],  sur,  xyz[3],  tmp2; 

/*  initialize  time  */ 
tstep  =  (float) 0.; 
t  =  tstep  *  delt; 

/* 


- c  */ 

/*  -  missile  state  initialization  module 

- c  */ 

/* 


- c  */ 

/*  initialize  states  and  state  derivatives  */ 
d_l  =  dtr  *  (float) -90.; 
d_2  *  lat Ip  *  dtr; 
d_3  =  longlp  *  dtr; 

mm]c_(&d_l,  &c _ 1,  &d_2,  &c _ 2,  &d_3,  &c _ 3,  cei)  ; 

trans  (cei,  cie) ; 


- -k/ 

/*  initialize  processor  inputs  if  not  already  initialized  */ 

/*  p2  */ 

qa  =  (float) 0 . ; 
mach  =  (float) 0 . ; 

/*  p5  */ 

for  (i  =  1;  i  <=  3;  ++i)  { 
vrwm[i  -  1]  =  (float) 0.; 

/*  LIO:  */ 

) 

/* 


- c  */ 

/* - main  execution  loop 

- c  */ 

/* 


- c  */ 

L20: 

/* 

"kicit'kiciticit'kititic'kiricitit-kie'k’k'kit'k'k'kifitificitifit'k'kit'k'kicicit'k'k-k'kicitit'kic-k'kitic'kit'k'kititif'k-kititicifitiK'kif 

*/ 

/*  *  */ 

/*  partition  1  *  */ 

/  *  *  *  / 

/* 

'k'k'k’k'k-k’k'kic^ickie'k'k^'k'k'k-kisitifkick'kifk-k-k'k’kit-kitk-kit'kitic-k-k^^-k-k'k-kicif’kitiKifk-kiticiC'k-k'kiticicic'k'k'ic 

*/ 

send_real_32bit _ (&mach) ; 

send_real_32bit _ (&qa) ; 

send_real_32bit _ (vrwm) ; 

send_real_32bit _ (&vrwm[l])  ; 

send_real_32bit _ (&vrwm[23 ) ; 

d_l  =  omegae  *  t; 

mmk_(&c_b6,  &c _ 1,  &c_b6,  &c _ 2,  &d_l,  &c _ 3,  cer)  ; 

mmlxy_(cer,  cie,  cir)  ; 
trans_(cir,  cri) ; 

/* - get  parameters  from  main  partition  1  thread 

- c  */ 

receive_real_64bit _ (xyz)  ; 

receive_real_64bit _ ( &xyz [ 1 ] ) ; 
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receive_real_64bit _ (&xyz  [2] )  ; 

receive_real_64bit _ (xyzd) ; 

receive_real_64bit _ (&xyz<J[l] )  ; 

receive_real_64bit _ {&xyzdi2i ) ; 

receive_real_32bit _ (cim)  ; 

receive_real_32bit _ (&cim[l] ) ; 

receive_real_32bit _ (&cim[2i )  ; 

receive_real_32bit _ (&cim[3] )  ; 

receive_real_32bit _ (&cimi4i ) ; 

receive_real_32bit _ (&cirr.(5i ) ; 

receive_real_32bit _ (&cim[6i ) ; 

receive_real_32bit _ Ucim  f7  j ) ; 

receive_real_32bit _ (fcimlS] ) ; 

xyzefO]  =  cie[0]  *  xyzCO]  +  ciet3]  *  xyz[l]  +  cie[6]  *  xyz[2]; 

xyzeil]  =  cie[l]  *  xyzio]  +  ciet4]  *  xyzil]  +  ciei?]  *  xyzlz]; 

xyze[2]  =  cie(2]  *  xyz[0]  +  cie(53  *  xyz[l]  +  cie[8]  *  xyz(2]; 

vecrot_(xyze,  cer,  xyzr) ; 

/*  calculate  current  latitude  and  longitude  */ 

/*  Computing  2nd  power  */ 
d_2  *=  xyzr[0]; 

/*  Computing  2nd  power  */ 
d_3  =  xyzr[l]; 

d_l  =  sqrt(d_2  *  d_2  +  d_3  *  d_3) ; 
lat  =  arctan_(&xyzr [2] ,  &d_l); 
long_  =  arctan_(&xyzr [1] ,  xyzr) ; 

/*  **********  start  of  winds  subroutine 

'k'kitit-kitir’k'Air'kitititieieitititititick-kititititit'klr 

c  */ 

/*  call  mmk (0 . OdO, 1, -lat, 2, long, 3, crw)  */ 

/*  call  trans (crw, cwr)  */ 

a  =  cos (- (doublereal) lat) / 
b  =  sin (- (doublereal) lat) ; 
c  =  cos(long_); 
d  =  sin {long_) ; 
cwr(0]  =3*0; 
cwr[l]  =  d; 
cwr [2]  =  b  *  c; 
cwr [3]  =  a  *  d; 
cwr [ 4 ]  =  c ; 
cwr  [5]  =  b  *  d; 
cwr [6]  =  b; 
cwr [7]  =  (float) 0.; 
cwr [ 8 ]  =  a ; 

/*  -  get  masspr  table  loo)c  up  values  from  other  processors 

- c  */ 

receive_real_32bit _ (&vwind)  ; 

receive_real_32bit _ (&shear) ; 

receive_real_32bit _ (Sswdir) ; 

receive_real_32bit _ (Scwdir) ; 

/*  call  vm)c  (shear,  cwdir*vwind,  swdir*vwind, vwwind)  */ 

vwwind[0]  =  shear; 
vwwind [1]  =  cwdir  *  vwind; 
vwwind [2]  =  swdir  *  vwind; 
vecrot_ (vwwind,  cwr,  vrwind) ; 
vecrot_(vrwind,  cri,  viwind) ; 
vecsub_(xyzd,  viwind,  vrwi) ; 

/*  call  vecrot (vrwi, cim, vrwm)  */ 

vrwm[03  =  cim[0]  *  vrwi[0]  +  cim(3]  *  vrwi[l]  +  cim(6]  *  vrwi[2]; 

vrwmil]  =  cim[l]  *  vrwi[0]  +  cim[4]  *  vrwiil]  +  cimi71  *  vrwi [2]; 

vrwmf2j  =  cimi2j  *  vrwi[0]  +  cim(5]  *  vrwiil]  +  cimis]  *  vrwii2i; 

/*  Computing  2nd  power  */ 
r_l  =  vrwm [ 0 ] ; 

/*  Computing  2nd  power  */ 
r_2  =  vrwm  [  1  ]  ; 
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/*  Computing  2nci  power  */ 
r_3  =  vrwm[2]; 

mvrwm  »  sqrt ( r_l  *  r_l  +  r_2  *  r_2  +  r_3  *  r_3 ) ; 

/*  **********  gnd  of  winds  subroutine 

•kit'kifkitifk'k'kic'kifititititititifkit'kititifititifkiiititit 

c  */ 

/*  -  calculate  parameters  from  aero  and  start  table  lookups  - 

c 

*/ 

receive_real_32bit _ (&vsnd) ; 

mach  »■  mvrwm  /  vsnd; 

/*  Computing  2nd  power  */ 
r_l  -  vrwm [ 1 ] ; 

/*  Computing  2nd  power  */ 
r_2  -  vrwm  [  2  ]  ; 

tmpl  «  sqrt(r_l  *  r_l  +  r_2  *  r_2) ; 

tmp2  >“  dabs  (vrwm [0] )  ; 

alfat  =  arctan_{fitmpl,  &tmp2)  /  dtr; 

send_real_32bit _ (Smach) ; 

send_real_32bit _ (ialfat) ; 

receive_real_32bit _ (&rhod2) ; 

/*  Computing  2nd  power  */ 
d_l  -  mvrwm; 
qa  ••  d_l  *  d_l  *  rhod2; 

/* - perform  part  of  aero  subroutine 

- c  */ 

if  (mvrwm  <=  0.  I  1  t  >=  tstg2)  { 
fxa  =  (float) 0 . ; 
fya  *  (float) 0 . ; 
fza  »  (float) 0 . ; 

receive_real_32bit _ (4ca) ; 

receive_real_32bit _ (&cn) ; 

}  6XS6  { 

if  (abs(tmpl)  >  le-6)  ( 

cphia  =  vrwm (2]  /  tmpl; 
sphia  =  vrwmil]  /  tmpl; 

)  else  { 

cphia  =  1 . ; 
sphia  =  0 . ; 

) 

if  (t  >  tstgl)  { 
sur  =  sref2; 

}  else  { 

sur  =  srefl; 

1 

qs  =  qa  *  sur; 

receive_rftal_32bit _ (&ca) ; 

receive_real_32bit _ (&cn)  ; 

fxa  =  qs  *  ca; 

fya  =  -qs  *  cn  *  sphia; 

fza  =■  -qs  *  cn  *  cphia; 

) 

send_real_32bit _ (&fxa) ; 

send_real_32bit _ (&fya) ; 

send  real  32bit  (&fza) ; 

/* 

*/ 

/ *  *  */ 

/* 

*  *  y 


end  of  partition  1 
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*/ 

/*  increment  time  */ 
tstep  +=  (float)!.; 
t  *  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  L20; 

} 

)  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main 


{  MAIN  0;  ) 
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A.3.8  Boost2a2.c 

/"'  boost2a2.f  —  translated  by  f2c  (version  of  3  February  1990 
3:36:42)  . 

You  must  link  the  resulting  object  file  with  the  libraries: 
-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

#include  ''f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 1  =  1; 

static  integer  c _ 2  =  2; 

static  integer  c _ 3  =  3; 

static  integer  c _ 12  =  12; 

static  integer  c _ 13  =  13; 

static  integer  c _ 14  =  14; 

static  integer  c _ 15  =  15; 

static  integer  c _ 16  =  16; 

static  integer  c _ 17  =  17; 

static  integer  c _ '' 9  =  18; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 

static  real  phiicd  =  (float) 0.; 

static  real  thticd  =  (float) -35.; 

static  real  psiicd  =  (float) 0.; 

static  real  tfinal  =  (float) 62 . 501; 

static  real  dtr  =  (float) .017453292519943296; 

static  real  tmpl  =  (float) 0.; 

static  real  quatm  =  (float) 1.; 

static  real  told,  quat[4]; 

static  integer  itst; 

extern  doublereal  sparctan_(); 

extern  /*  Subroutine  */  int  spincegi_  ; 

static  integer  i; 

static  real  p,  q,  r,  t,  quatd[4]; 

extern  /*  Subroutine  */  int  fvdot_(),  spnimk_(); 

static  real  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (),  bxi2fv_(), 

f v2bxi_ ( ) ; 

static  real  pd,  qd,  rd; 
extern  doublereal  arcsin_(); 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

static  real  cim[9],  cmi(9],  phi,  psi; 
extern  /*  Subroutine  */  int  vrak_(); 
static  real  tht,  pqr[3]; 

extern  /*  Subroutine  */  int  sp'’nteg_(),  sptrans_(); 
static  real  tmp2; 

/*  initialize  time  */ 
tstep  =  (float) 0 . ; 
t  =  tstep  "  delt; 
for  (i  =  1;  i  <=  3;  ++i)  { 
pqr[i  -  1]  =  (float) 0.; 

/*  LIO:  */ 

) 

phi  =  phi’cd  *  dtr; 
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tht  =  thticd  *  dtr; 
psi  =  psiicd  *  dtr; 

spmmk_{&phi,  &c _ 1,  &tht,  &c _ 2,  &psi,  &c _ 3,  cim) ; 

sptrans_{cim,  cmi) ; 

/* 


- c  */ 

/*  -  missile  state  initialization  module 

- c  */ 

/* 


- c  */ 

/*  initialize  states  and  state  derivatives  */ 
bxi2fv_(&quatm,  cmi,  quat); 
pd  =  (float) 0 . ; 
qd  =  (float) 0 .  ; 
rd  =  (f loatl 0  .  ; 

fvdot_(pqr,  stmpl,  quat,  quatd) ; 

spintegi_(pqr,  &pd,  &t,  &c _ 12); 

spintegi_(&pqr [1] ,  &qd,  &t,  &c _ 13); 

spintegi_(&pqr [2] ,  &rd,  &t,  ic _ 14); 

spintegi_(quat,  quatd,  &t,  &c _ 15); 

spintegi _(&quat [1] ,  &quatd[l],  &t,  &c _ 16); 

spintegi_2(&quat  [2] ,  &quatd[2],  &t,  &c _ 17); 

spintegi_(&quat [3] ,  &quatd[3],  &t,  &c _ 18); 

p  =  pqr [0] ; 
q  =  pqr [1] ; 
r  =  pqr [2] ; 
itst  =  0; 

/* 


- c  */ 

/* - - main  execution  loop 

- c  */ 

/* 


- c  */ 

L20: 

/* 

*/ 

/* 

/* 

partition  1 

★  ★  / 

*  *  / 

/* 

/* 

*  *  / 

*/ 

send_real_32bit _ (cim) ; 

send_real_32bit _ (&cim[l] ) ; 

send_real_32bit _ (&cim[2i ) ; 

send_real_32bit _ (scimP] )  ; 

send_real_32bit _ (&cim[4] ) ; 

send_real_32bit _ (&cim[5] ) ; 

send_real_32bit _ Ucim(6] ) ; 

send_real_32bit _ (ScimC?] ) ; 

send_real_32bit _ (&cim(8] ) ; 

/*  Added  for  graphics  program  */ 

send_real_32bit _ (&phi) ; 

send_real_32bit _ (&tht) ; 

send_real_32bit _ ^(&psi) ; 

receive_real_32bit _ (&pd) ; 

receive_re^>l_32bit _ (&qd)  ; 

receive_real_32bit _ (&rd) ; 

if  (itst  ==  0)  { 
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itst  =  1; 

}  else  { 

spinteg_(&p,  &pci,  stold,  &c _ 12); 

spinteg_(&qf  &qd,  &told,  &c _ 13) ; 

spinteg_(&r,  &rd,  &told,  &c _ 14) ; 

} 

p  +=  delt  *  pd; 

q  +=  delt  *  qd; 

r  +=  delt  *  rd; 

quat[0]  +=  delt  *  quatd[0]; 

quat[l]  +=  delt  *  quatd[l]; 

quat[2]  +=  delt  *  quatd[2]; 

quatiS]  +=  delt  *  quatdis]; 

/*  - section  of  missil  subroutine  that  finds  phi,  tht,  and 

psi - c  */ 

vm]c_(&p,  &q,  &r,  pqr)  ; 

tmp2  =  (float)O.; 

fvdot_(pqr,  &tmp2,  quat,  quatd) ; 

fv2bxi_(quat,  &tmp2,  cmi) ; 

sptrans_(cmi,  cim) ; 

phi  =  sparctan_(&ciTn[7] ,  &cim[8]); 

tht  =  - (doublereal) arcsin_(&cim(6] )  ; 

psi  =  sparctan_{&cimr3] ,  cim)  ; 

/* 


- c  */ 

/* 

c 

*/ 

/* 


missile  state  ince7’"»tif.n  module 


- c  */ 

spinteg_(quat,  quatd,  &t,  &c _ 15); 

spinteg_(&quat [1] ,  &quatd[l],  &t,  &c _ 16); 

spinteg_Uquac  [2] ,  &quatd[2],  &t,  &c _ 17); 

spinteg  (squat [3],  &quatdi3i,  &t,  &c  18); 

/* 

*/ 

/  *  *  *  / 

/*  end  of  partition  1 

*  */ 

/*  *  */ 

/* 

*/ 

told  =  t; 

/*  increment  time  */ 
tstep  +--  (float)!.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  L20; 

} 

)  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  {  MAIN _  ();  } 
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A.3.9  Boost2a3.c 

/*  boost2a3.f  —  translated  by  f2c  (version  of  3  February  1990 
3:36:42) . 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

#include  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 12  =  12; 

static  integer  c _ 13  =  13; 

static  integer  c _ 14  =  14; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  doublereal  delt  =  .001; 
static  doublereal  xlnch  =  3 . ; 
static  doublereal  gmu  =  1 . 4052477el6; 
static  doublereal  tfinal  =  62.501; 
static  doublereal  rade  =  20898908.; 
static  integer  nclear  =  0;' 
static  integer  imis  =  0; 

/*  System  generated  locals  */ 
doublereal  d_l; 

/*  Local  variables  */ 

extern  /*  Subroutine  */  int  magt_(); 

static  real  frcx,  mass,  frcy,  frcz,  mrcx,  mrcy,  mrcz; 

extern  /*  Subroutine  */  int  spintegi_() ; 

static  doublereal  mxyz,  uxy2[3];  "" 

static  integer  i; 

static  real  p,  q,  r; 

static  doublereal  t,  tstep; 

extern  /*  Subroutine  */  int  mvbys_(),  receive_real_32bit _ (), 

receive _real_64bit _ () ; 

static  doublereal  gb[3]; 
static  real  cg[3],  pd,  qd,  rd; 

static  doublereal  gr[3],  fx,  fy,  fz,  mx,  my,  mz; 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

static  doublereal  xyzlch[3]; 

static  real  cim[9],  cmi[9],  fxa,  fya,  fza; 

static  doublereal  mxa,  mya,  mza,  mgr; 

static  real  xcp,  fxt,  fyt,  fzt,  pqr[3],  spt,  ixx,  mxt,  iyy,  myt, 
izz,  mzt; 

extern  /*  Subroutine  */  int  spinteg_(); 

static  doublereal  xyz[3]; 

extern  /*  Subroutine  */  int  sptrans_(); 

/*  $include (' :pfp: include/target . for ' )  */ 

/*  initialize  time  */ 
tstep  =  (float) 0 . ; 
t  =  tstep  *  delt; 
for  (i  =  1;  i  <=  3;  ++i)  ( 
pqr[i  -  1]  =  (fl''3t)0.; 

/*  LIO:  */ 

} 
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/* 


- c  */ 

/*  -  missile  state  initialization  module 

- c  */ 

/* 


- c  */ 

/*  initialize  states  and  state  derivatives  */ 
pd  =  (float) 0 . ; 
qd  =  (float) 0  .  ; 
rd  =  (float) 0 . ; 
spt  =  t; 

spintegi_(pqr,  &pd,  &spt,  &c _ 12) ; 

spintegi_(&pqr (1] ,  &qd,  &spt,  &c _ 13); 

spintegi_(&pqr [2] ,  &rd,  &spt,  &c _ 14); 

p  =  pqr [ 0 ] ; 
q  =  pqr [ 1 ] ; 
r  =  pqr [2] ; 

for  (i  =  1;  i  <=  3;  ++i)  { 
gr [i  -  1]  =  (float) 0  .  ; 

/*  L20:  */ 

) 


- c  */ 

/* - main  execution  loop 

- c  */ 

/* 


- c  */ 

L30: 

/*  *  *  * 

*/ 

/  it  it  it  / 

/*  partition  1  *r  */ 

/*  tc  *  / 

/* 

*/ 

/* - send  parameters  to  partitions  3,  4,  and  5 

- c  */ 


send_real_32bit _ (&p)  ; 

send_real_32bit _ (&q)  ; 

send_real_32bit _ (&r)  ; 

send_real_32bit _ (&pd) ; 

send_real_32bit _ (&qd)  ; 

send_real_32bit _ (&rd)  ; 

receive_real_32bit _ (&m.ass)  ; 

receive_real_64bit _ (xyz)  ; 

receive_real_64bit _ (&xyz(l] ) ; 

receive_real_64bit _ (&xyz [2] ) ; 

receive_real_32bit _ (cim)  ; 

receive_real_32bit _ (&cim[l])  ; 

receive_real_32bit _ (&cimi2] ) ; 

receive_real_32bit _ (&cim[3]) ; 

receive_real_32bit _ (&cim[4] ) ; 

receive_real_32bit _ (&cim[5] ) ; 

receive_real_32bit _ (&cim[6]) ; 

receive_real_32bit _ (&cim(7] ) ; 

receive_real_32bit _ (&cim[8) ) ; 

/*  -  receive  parameters  from  partition  #2 

- c  */ 
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/* 


/* 


/* 


receive_real_32bit _ (&fxt)  ; 

receive_real_32bit _ (&fyt)  ; 

receive_real_32bit _ (&fzt) ; 

receive_real_32bit _ (&mxt)  ; 

receive_real_32bit _ (&myt)  ; 

receive_real_32bit _ (&mzt)  ; 

receive_real_32bit _ (&frcx)  ; 

receive_real_32bit _ i&frcy) ; 

receive_real_32bit _ (&frcz) ; 

receive_real_32bit _ (&mrcx) ; 

receive_real_32bit _ (&mrcy) ; 

receive_real_32bit _ (&mrcz) ; 

-  mass  properties  module 

- c  */ 

receive_real_32bit _ (eg)  ; 

receive_real_32bit {&cg[l] )  ; 

receive_real_32bit Ucgi2])  ; 

receive_real_32bit _ (&ixx)  ; 

receive_real_32bit _ (&iyy) ; 

receive_real_32bit _ (&izz)  ; 

p  +=  delt  *  pd; 

q  +=  delt  *  qd; 

r  +=  dele  *  rd; 

-  vehicle  states  module 

- c  */ 


- */ 

if  (imis  ==  0)  { 
sptrans_{cira,  cmi) ; 
xyzlch[0]  =  xlnch  *  cmi[0]  +  rade; 
xyzlchil]  =  xlnch  *  cmiil]; 
xyzlch[2]  =  xlnch  *  cmi[2]; 
imis  =  1; 

} 

magt_(xyz,  &mxyz,  uxyz); 

/*  Computing  2nd  power  */ 


d_l  =  mxyz; 

mgr  =  gmu  /  (d_l  *  d_l); 
d_l  =  -mgr; 

mvbys_(&d_l,  uxyz,  gr) ; 

/*  CALL  vecrot  (gr,  cim,  gb)  */ 

gb[0]  =  cim[0]  *  gr[0]  +  cim[3]  *  gr[l]  +  cim[6]  *  gr[2]; 

gb[l]  =  cim[li  *  grio]  +  cim [4]  *  gr[l]  +  cim [7]  *  gri2]; 

gb[2i  =  cim [2]  *  gr[0]  +  cim [5]  *  gr[l]  +  cim[8]  *  gr[2]; 

/* - section  of  aero  subroutine  to - c 

*/ 

/* - calculate  mxa,mya,  and  mza  from  fxa,fya,and  fza  — c 

*/ 


receive_real_32bit_  (&fxa) 

receive_real_32bit _ ^(&fya) 

receive_real_32bit _ {  &  f za) 

receive_real_32bit _ {&xcp) 


mxa  =  fya  *  eg [2]  -  fza  *  cg[l]; 

mya  =  - (doublereal) fxa  *  eg [2]  +  fza  *  (cg[0]  -  xcp) ; 
mza  =  fxa  *  cg[l]  -  fya  *  (cg[0]  -  xcp) ; 

/* - section  of  missil  subroutine  to  find 

c 

*/ 

/* -  and  rd 

c 

*/ 


fx  =  fxt  +  fxa  +  frex; 
fy  =  fyt  +  fya  +  frey; 
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fz  =  fzt  +  fza  +  frcz; 
mx  =  mxa  +  mxt  +  mrcx; 
my  =  mya  +  myt  +  mrcy; 
mz  =  mza  +  mzt  +  mrcz; 
if  (nclear  ==  1)  { 
pd  =  (float) 0. ; 

qd  =  my  /  iyy  +  r  *  p  *  ((izz  -  ixx)  /  iyy) ; 

rd  =  mz  /  izz  +  p  *  q  *  ( (ixx  -  iyy)  /  izz)  ; 

}  else  if  (fx  /  mass  <=  abs(gb(03))  { 

pd  =  (float) 0 . ; 
qd  =  (float) 0. ; 
rd  =  (float) 0. ; 

}  else  if  (xyz[03  <=  xyzlch[0]  &&  xyz[l]  <=  xyzlch[l]  &&  xyz[2]  <= 
xyzlch[ 

2])  { 

pd  =  (float) 0 . ; 
qd  =  (float) 0. ; 
rd  ■=  (float)  0 . ; 

}  else  { 
nclear  =  1; 

/*  call  output_message (  %val (character_08bit) ,  */ 

/*  .  '  missile  has  cleared  the  launcher'  )  */ 

/•'  call  output_nl  */ 

pd  =  (float) 0 . ; 

qd  =  my  /  iyy  +  r  *  p  *  ((izz  -  ixx)  /  iyy); 
rd  =  mz  /  izz  +  p  *  q  *  ((ixx  -  iyy)  /  izz)  ; 

) 

/* 


- c  */ 

/*  missile  state  integration  module 

c 
*/ 

/* 


c  */ 


spt  =  ,t; 

spinteg_(&p,  &pd. 

&spt, 

&c_ 

12)  ; 

spinteg~(&q,  &qd, 

&spt. 

&c_ 

’13)  ; 

spinteg_(&r,  &rd, 

&spt, 

&c _ 

'14)  ; 

/* 

*/ 

/*  *  */ 

/*  end  of  partition  1 

*  -k ! 

/  *  *  *  / 

/* 

*/ 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  L30; 

) 

}  /*  MAIN _ */ 

/*  Main  program  alias  */  int  main_  ()  (  MAIN _  ();  } 
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A.3.10  Boost2b.c 

/*  boost2b.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


finclude  "f2c.h" 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  real  tfinal  =  (float) 62 .501; 
static  real  tstg2  =  (float) 62.5; 
static  real  tfrac  =  (float) 23001 . ; 
static  real  dtfru  =  (float) 5.; 
static  real  tfrcs  =  (float) 23 . 001; 

static  real  mach,  dlpc; 
static  integer  lenf[4]; 

static  real  dlyc,  frcx,  frcy,  frcz,  mrcx,  mrcy,  mrcz; 
static  integer  i,  j; 
static  real  t; 

extern  /*  Subroutine  */  int  fracs_(); 
static  real  mdotf,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  eg [3],  qa,  pmC3],  malpha,  sq,  sr,  mdltfr; 

extern  /*  Subroutine  */  int  frcthr_(),  send_real_32bit _ (); 

static  real  thf[40]  /*  was  [10]  [4]  */,  tmf[40]  /*  was  [10]  [4]  */; 

/*  initialize  time  */ 
tstep  =  (float) 0. ; 
t  =  tstep  *  delt; 
for  (i  =  1;  i  <=  10;  ++i)  { 
for  (j  =  1;  j  <=  4;  ++j)  ( 

tmf[i  +  j  *  10  -  11]  =  (float) 0.; 
thf[i  +  j  *  10  -  11]  =  (float)O.; 

/*  LIO:  */ 

} 

/*  L20:,  */ 

} 

for  (i  =  1;  i  <=  4;  ++i)  { 
lenf[i  -  1]  =  0; 

/*  L30:  */ 

) 

/* 


- c  */ 

/* - 

- c  */ 

/*  pi  */ 
frcx  = 
frcy  = 
frcz  = 
mrcx  = 
mrcy  = 
mrcz  = 
mdotf  = 

/* 


(float) 0 . ; 
(float) 0 . ; 
(float) 0. ; 
(float) 0 . ; 
(float) 0 . ; 
(float) 0 . ; 
(float) 0 . ; 


missile  state  initialization  module 


c  */ 
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/* 

/* 


c  */ 


main  execution  loop 


- c  */ 

L40: 

/* 

*/ 

/*  partition  2  *  */ 

/*  *  */ 

/* 


*/ 

/* - send  parameters  to  partition  #1 

- c  */ 

send_real_32bit _ (sfrcx)  ; 

send_real_32bit _ (&frcy) ; 

send_real_32bit _ (&frcz)  ; 

send_real_32bit _ (&mrcx)  ; 

send_real_32bit _ (&mrcy)  ; 

send_real_32bit _ (fimrcz)  ; 

send  real  32bit  {&mdotf) ; 


/*  -  receive  parameters  from  partition  #1 

- c  */ 

receive_real_32bit _ (eg) ; 

receive_real_32bit _ (&cg[l] )  ; 

receive_real_32bit _ (&cg[2] )  ; 

/*  -  receive  parameters  from  partition  #1 

- c  */ 

receive_real_32bit _ (fimach) ; 

receive_real_32bit _ (&qa) ; 

/*  -  receive  parameters  from  partition  #3,4,  and  5 


- c  */ 

receive_real_32bit _ (&dlpc) ; 

receive_real332bit _ (&dlyc) ; 

receive_real_32bit _ (&sq) ; 

receive_real_32bit _ (&sr) ; 

receive_real_32bit _ (&mdltfr) ; 

receive_real_32bit _ (&malpha) ; 

receive_real_32bit _ (pm) ; 

receive_real_32bit _ (&pm[l] ) ; 

receive_real_32bit _ (&pm(2] ) ; 

/*  -  fracs  thruster  response  module 

- c  */ 

if  (t  >=  tfres  &&  t  <  tstg2)  { 

frcthr_(&t,  eg,  Smach,  &qa,  tmf,  thf,  lenf,  sfrex,  sfrey,  sfrez,  & 
mrex,  Smrey,  Snircz,  Smdotf)  ; 

/*  -  fracs  logic  module 

- c  */ 

if  (tstep  >=  tfrac)  { 

fracs_(&t,  Sdlpc,  &dlyc,  &sq,  &sr,  fimdltfr,  smalpha,  pm,  tmf, 

thf, 

lenf) ; 

tfrac  +=  dtfru; 


} 

}  else  ( 

frex  =  (float) 0 . 
frey  -  (float) 0 . 
frez  =  (float) 0. 
mrex  =  (float) 0 . 
mrcy  =  (float) 0 . 
mrez  =  (float) 0. 
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mdotf  =  (float) 0.; 

) 

/* 

*********************************************************************** 
*/ 

/* 

/* 

*  */ 

/* 

/* 

*/ 

/*  increment  time  */ 
tstep  +=  (float) 1 .  ; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  L40; 

} 

)  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  (  MAIN _  ();  } 


end  of  partition  2 


*  -k ! 
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A.3.11  Boost2bl.c 

/*  boost2bl.f  —  translated  by  f2c  (version  of  3  February  1990 
3:36:42) . 

You  must  link  the  resulting  object  file  with  the  libraries: 
-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


finclude  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 19  =  19; 

static  integer  c _ 20  =  20; 

/*  Main  program  */  MAIN _ () 

( 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  real  dlyic  =  (float) 0.; 
static  real  tfinal  =  (float) 62 . 501; 
static  real  tstgl  =  (float) 23.; 
static  real  tinhib  =  (float). 35; 
static  real  pmax  =  (float) .13963; 
static  real  dlpic  =  (float) 0.; 

/*  System  generated  locals  */ 
real  r_l,  r_2; 

/*  Local  variables  */ 
static  real  cmmd[2],  dlpd,  dlyd; 
extern  /*  Subroutine  */  int  spintegi_(); 
static  real  t,  mdott,  press,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  eg [3],  totdel; 

extern  /*  Subroutine  */  int  send_real_32bit _ (),  bthrst_() ; 

static  real  dip; 

extern  /*  Subroutine  */  int  ncu_(); 

static  real  dly,  fxt,  fyt,  fzt,  mxt,  myt,  mzt; 

extern  /*  Subroutine  */  int  spinteg_(); 

/*  initialize  time  */ 
tstep  =  (float) 0 . ; 
t  =  tstep  *  delt; 

/* 


- c  */ 

/*  -  missile  state  initialization  module 

- c  */ 

/* 


- c  */ 

/*  initialize  states  and  state  derivatives  */ 
dip  =  dlpic; 
dly  =  dlyic; 
dlpd  =  (float) 0. ; 
dlyd  =  (float) 0 .  ; 

spintegi_(&dlp,  &dlpd,  &t,  &c 19); 

spintegi_(&dly,  &dlyd,  &t,  &c 20); 


*/ 
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/*  initialize  processor  inputs  if  not  already  initialized  */ 
/*  pi  */ 

fxt  =  (float) 0  .  ; 
fyt  =  Uloatio.; 
fzt  =  (float) 0.; 
mxt  =  (float) 0. ; 
myt  =  (float) 0.; 
mzt  =  (float) 0 . ; 
mdott  =  (float)O.; 

/* 


- c  */ 

/* - main  execution  loop 

- c  */ 

/* 


- c  */ 

LIO: 

/* 


*/ 

/* 

it  it ! 

/* 

partition  2 

*  */ 

/* 

it  it  ! 

/* 

’k'kick'k-kif'kfe'k’kific'k'kici 

k'k-k-k-kififkif’kifk'kicit’kie'^ickif'kifkic-kifkifk'k'k 

itititititifkitititititititit 

*/ 

/* - send  parameters  to  partition  #l 

- 2  */ 

send_real_32bit _ (&fxt)  ; 

send_real_32bit _ (&fyt) ; 

send_real~32bit _ (&fzt) ; 

send_real“32bit _ (&mxt) ; 

send_real_32bit _ (&myt)  ; 

send_real_32bit _ Umzt)  ; 

send_real  32bit  {smdott) ; 


/* - “receive  parameters  from  partition  #1 

- c  */ 

receive_real_32bit _ (eg)  ; 

receive_real_32bit _ (&cg[l]) ; 

receive_real_32bit _ (&cgi2i )  ; 

/*  -  receive  parameters  from  partition  #1 

- ^  */ 

receive_real_32bit _ (spress) ; 

/*  -  receive  parameters  from  partition  #3,4,  and  5 

- c  */ 

receive_real_32bit _ (emmd)  ; 

receive_real_32bit _ (&cmmd[l] ) ; 


if  (t  <=  tstgl)  { 
dip  +=  delt  *  dlpd; 
dly  +=  delt  *  dlyd; 

/*  Computing  2nd  power  */ 
r_l  =  dip; 

/*  Computing  2nd  power  */ 
r_2  =  dly; 

totdel  =  sqrt(r_l  *  r_l  +  r_2  *  r_2) ; 
if  (totdel  >  pmax)  { 

dip  =  dip  *  pmax  /  totdel; 
dly  -  dly  *  pii'dx  /  totdel; 

) 

) 

/*  -  boosters  module 

- c  */ 
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bthrst_(&t,  eg,  spress,  &dlp,  &dly,  sfxt,  &fyt,  &fzt,  &mxt,  &myt, 
£mzt,  & 

mdott) ; 

/*  -  nozzle  control  unit  module 

- c  */ 

if  (t  <*=  tstgl)  { 
if  (t  >  tinhib)  { 

ncu_(&dlp,  &dly,  emmd,  &dlpd,  fidlyd) ; 

)  else  { 

dlpd  =  (float) 0. ; 
dlyd  -  (float) 0. ; 

} 

spinteg_(&dlp,  sdlpd,  &t,  &c 19) ; 

spinteg_(fidly,  &dlyd,  &t,  sc 20) ; 

/*  Computing  2nd  power  */ 
r_l  ••  dip; 

/*  Computing  2nd  power  */ 
r_2  *•  dly; 

totdel  =  sqrt(r_l  *  r_l  +  r_2  *  r_2) ; 
if  (totdel  >  pmax)  { 

dip  -  dip  *  pmax  /  totdel; 
dly  “  dly  *  pmax  /  totdel; 

) 

)  else  ( 

dip  =  (float) 0 , ; 
dly  “  (float) 0 . ; 

) 

/* 

*1 

/*  *  */ 

/*  end  of  partition  2 

*  *  / 

/*  *  */ 

/* 

*/ 

/*  increment  time  */ 
tstap  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

} 

)  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  {  MAIN _  ();  ) 


178 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


A.3.12  Boost2c.c 

/*  boost2c.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

#include  "f2c.h" 


/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 


static 

static 

static 

static 

static 

static 

static 

static 

static 

static 


real  delt  =  (float) .001; 

real  dtr  =  (float) .017453292519943296; 

real  thticd  =  (float) -35.; 

real  psiicd  =  (float) 0.; 

real  vpl  =  ( float) 13770 . ; 

real  usOd  -  (float) -22.; 

real  tfinal  =  (float) 62. 501; 

real  tstg2  =  (float) 62.5; 

real  tst2on  =  (float) 22 . 995; 

real  dtbgu  =  (float) 5.; 


/*  System  generated  locals  */ 
real  r_l,  r_2,  r_3; 


/*  Local  variables  */ 

static  real  delu,  delv,  delw,  spsi,  tgpu,  stht,  dtmpl; 
static  integer  i; 
static  real  t; 

extern  /*  Subroutine  */  int  bguid_(); 
static  real  delxd,  delyd,  delzd; 
extern  /*  Subroutine  */  int  navig_(); 
static  real  attlm,  psier,  thter,  tlgpu,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  ac(3],  at[3],  pg[3],  dt,  gr[3],  pm[3],  sq,  sr,  delphi, 
us[3], 

vw(3],  delpsi,  deltht; 

extern  /*  Subroutine  */  int  bsteer_(),  send_real_32bit _ (); 

static  real  mvrdot,  pgd[3],  usd[3],  vwd[3],  pqr[3],  mvr,  mvs, 
uvs [3] , 

ti2m[9] ; 


/*  initialize  time  */ 
tstep  =  (float) 0 . ; 
t  =  tstep  *  delt; 
for  (i  =  1;  i  <=  3;  ++i)  { 
pqr[i  -  1]  =  (float) 0.; 
usdfi  -  1]  =  (float) 0.; 
pgdii  -  1]  =  (float) 0.; 
vwdii  -  1]  =  (float) 0.; 
vw[i  -  1]  =  (float) 0.; 

/*  LIO:  */ 

} 

mvrdot  =  (float) 0.; 
stht  =  thticd  *  dtr; 
spsi  =  psiicd  *  dtr; 
sq  =  pqr [1] ; 
sr  =  pqr [2] ; 

us[0]  =  cos (spsi)  *  cos(us0d  *  dtr) ; 
usil]  =  sin  (spsi)  *  cos(us0d  *  dtr) ; 
us [2]  =  - (doublereal) sin (usOd  *  dtr) ; 
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pg[0]  =  cos(spsi)  *  cos(stht); 
pg[l]  =  sin(spsi)  *  v,os(stht); 
pg[2i  =  - 'doublereal) sin (stht) ; 


- c  */ 

I*  - -  missile  state  initialization  module 

- c  */ 

/* 


- */ 

/*  initialize  processor  inputs  if  not  already  initialized  */ 
for  (i  =  1;  i  <=  3;  ++i)  { 
pm[i  -  1]  =  (float) 0.; 

/*  L20:  */ 

) 

delu  =  (float) 0.; 
delv  =  (float) 0  . ; 
delw  =  (float) 0 . ; 
for  (i  =  1;  i  <=  3;  ++i)  { 
at(i  -  1]  =  (float) 0.; 

/*  L30:  */ 

) 

for  (i  =  1;  i  <=  9/  ++i)  { 
ti2m(i  -  1]  =  (float) 0.; 

/*  L40:  */ 

) 

mvr  =  vpl; 

/*  initialization  routine  */ 
tgpu  =  (float) 0.; 
tlgpu  =  (float) 0.; 


- c  *! 

/* - main  execution  loop 


- c  */ 

L50: 

/* - send  parameters  to  partition  #2 

- c  */ 

send_real_32bit _ (at) ; 

send_real_32bit _ (&at (1] ) ; 

send_real_32bit _ (&at [2] ) ; 

send_real_32bit _ (Sdelxd) ; 

send_real_32bit _ (Sdelyd) ; 

send_real_32bit _ (&delzd) ; 

send_real_32bit _ (pm) ; 

send_real_32bit _ (&pm(l] ) ; 

send_real_32bi': _ (&pm[2i )  ; 

/*  -  receive  parameters  from  partition  #1 

- c  */ 

receive_real_32bit _ (gr) ; 

receive_real_32bit _ (&gr [1] ) ; 

receive_real_32bit _ (&gr[2j ) ; 

receive_real_32bit _ (smvs) ; 

receive_real_32bit _ (uvs)  ; 

receive_real_32bit _ (&uvs (1] ) ; 

receive_real_32bit _ (&uvs [2] ) ; 

receive_real_32bit _ (Sdelphi) ; 

receive_real_32bit _ (Sdeltht) ; 

receive_real_32bit _ (idelpsi) ; 

receive  real  32bit  (&delu) ; 
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/* 


receive_real_32bit _ (&delv) ; 

receive  real  32bit  (&delw) ; 


*/ 

/*  *  */ 

/*  partition  4  *  */ 

/*  *  */ 

/* 

*/ 

/*  -  navigation  module 

- c  */ 

navig_(&delphi,  sdeltht,  fidelpsi,  &delu,  &delv,  &delw,  gr,  &t,  &sq, 

&sr, 

ti2m,  at,  &delxd,  sdelyd,  fidelzd) ; 

/*  integrate  performance  velocity  remaining  using  navigation  output  */ 
if  (t  <  tst2on  1 1  t  >=  tstg2)  { 
mvrdot  =  ( float ) 0 . ; 

)  else  { 

/*  Computing  2nr’  power  */ 
r_l  =  at [0] ; 

/*  Computing  2nd  power  */ 
r_2  =  at  [1] ; 

/*  Computing  2nd  power  */ 
r_3  =  at  [2] ; 

mvrdot  =  - (doublereal) sqrt (r_l  *  r_l  +  r_2  *  r_2  +  r_3  *  r_3) ; 

) 

mvr  +=  delt  *  mvrdot; 
if  (mvr  <  (float) 0.)  ( 
mvr  =  (float) 0 . ; 

} 

/* 

*********************************************************************** 

*/ 

/*  *  */ 

/*  end  of  partition  4 

*  * ! 

/*  *  */ 

/* 

*/ 

/* 

*/ 

/*  *  */ 

/*  partition  5  *  */ 

/*  *  */ 

/* 


*/ 

/* - on  board  guidance 

processing - c*/ 


if  (tstep  >=  tgpu)  { 
tgpu  +=  dtbgu; 
dt  =  t  -  tlgpu; 
tlgpu  =  t; 

/*  integrate  guidance  states  from  last  pass  through  */ 


us  [0] 

+=  dt 

* 

usdfO] 

us[l] 

+=  dt 

* 

usd[l] 

us[2] 

+=  dt 

★ 

usd[2] 

pg[0] 

+=  dt 

★ 

pgd[0] 

pg[i] 

+=  dt 

* 

pgd[l] 

pg[2] 

+=  dt 

•k 

pgd[2] 
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vw [ 0 ]  +=  dt  *  vwd [ 0 ] ; 
vw [ 1 ]  +=  dt  *  vwd [ 1 ] ; 
vw[2]  +=  dt  *  vwd [2]; 

/*  Computing  2nd  power  */ 
r_l  =  pg[0] ; 

/*  Computing  2nd  power  */ 
r_2  =  pg[l]; 

/*  Computing  2nd  power  */ 

=  pgt2] ; 

dtmpl  =  sqrt(r_l  *  r_l  +  r_2  *  r_2  +  r_3  *  r_3) ; 
pg[0]  /=  dtmpl; 
pg[l]  /=  dtmpl; 
pg[2]  /=  dtmpl; 


/*  -  boost  steering  module 

- c  */ 

if  (t  <  tstg2)  { 

bsteer_(&t,  us,  uvs,  &mvs,  &mvr,  at,  usd,  ac) ; 

/*  -  boost  guidance  module 

- c  */ 

bguid_(&t,  at,  ac,  ti2m,  pg,  vw,  pgd,  vwd,  &psier,  sthter. 


pm)  ; 

}  else  { 

receive_real_32bit _ (Sattlm) ; 

} 

if  (t  >=  tstg2)  { 

usd[0]  =  (float) 0.; 
usdil]  =  (float) 0.; 
usd [2]  =  (float) 0.; 
pgd [01  =  (float) 0,; 
pgdil]  =  (float) 0.; 
pgd [2]  =  (float) 0.; 
vwd[0i  =  (float) 0.; 
vwdil]  =  (float) 0.; 
vwd [2]  =  (float) 0.; 

} 

)  else  { 

receive_real_32bit _ (sattlm) ; 

} 

send_real_32bit _ (spsier) ; 

send_real_32bit _ (sthter) ; 

send_real_32bit _ (&sq) ; 

send_real_32bit _ (&sr) ; 

/* 


*/ 

/* 

it  it ! 

/* 

*  */ 

end  of  partition  5 

/* 

/* 

it  it ! 

*/ 

/*  increment  time  */ 
tstep  +=  (float) 1 .  ; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  L50; 

} 

)  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  (  MAIN _  ();  ) 


182 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


A.3.13  Boost2cl.c 

/*  boost2cl.f  —  translated  by  f2c  (version  of  3  February  1990 
3:36:42) . 

You  must  link  the  resulting  object  file  with  the  libraries: 
-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


#include  "f2c.h" 

/*  Main  program  */  MAIN _ () 

( 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 

static  real  tfinal  =  (float) 62 .501; 

static  real  delu  =  (float) 0.; 

static  real  delv  =  (float) 0.; 

static  real  delw  =  (float) 0.; 

extern  /*  Subroutine  */  int  gyro_(),  accel_() ; 
static  real  p,  q,  r,  t,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  eg [3],  pd,  qd,  rd,  ud,  vd,  wd,  delphi,  delpsi,  deltht, 
pulsea [ 

3]; 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

static  real  pulsegt3]; 

extern  /*  Subroutine  */  int  imupro_(); 

/*  initialize  time  */ 
tstep  =  (float) 0 . ; 
t  =  tstep  *  delt; 

/* 


- c  */ 

/* - main  execution  loop 

- c  */ 

/* 


- c  */ 

LIO: 

/*  -  receive  parameters  from  partition  #1 

- c  */ 

receive_real_32bit _ (eg) ; 

receive_real_32bit _ (&cg[l] ) ; 

receive_real_32bit _ (&cg(2i ) ; 

receive_real_32bit _ (&p) ; 

receive_real  _32bit _ (&q)  ; 

receive_rear_32bit _ (&r) ; 

receive_real_32bit _ (&ud) ; 

receive_real_32bit _ (&vd) ; 

receive_real_32bit _ (&wd)  ; 

receive_real_32bit _ (&pd) ; 

receive_real_32bit _ (&qd) ; 

receive_real_32bit _ (&rd) ; 

/* 

*/ 

/*  *  */ 

/*  partition  3  *  */ 

/*  it  *  j 
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/* 

*/ 


/*  -  inertial  measurement  update 

- c  */ 

gyro_(&p,  &q,  &r,  &t,  pulseg) ; 

/*  -  inertial  measurement  update 

- c  */ 

accel_(&ud,  &vd,  &wd,  &p,  &q,  &r,  &pd,  &qd,  &rd,  eg,  &t,  pulsea) ; 

/*  - imu  processor  module 

- c  */ 

imupro_{pulsea,  pulseg,  sdelphi,  sdeltht,  sdelpsi,  sdelu,  sdelv. 


sdelw)  ; 

send_real_32bit _ (sdelphi) ; 

send_real_32bit _ (sdeltht) ; 

send_real_32bit _ (sdelpsi) ; 

send_real_32bit _ (&delu) ; 

send_real_32bit _ (sdelv)  ; 

send_real_32bit _ (&delw)  ; 

/* 

*/ 

/-  *  */ 

/*  end  of  partition  3 

*  *  / 

/*  *  */ 

/* 

*/ 

/*  increment  time  */ 
tstep  +=  (float) 1 .  ; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

} 

}  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  {  MAIN _  ();  } 
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A.3.14  Boost2c2.c 

/*  boost2c2.f  —  translated  by  f2c  (version  of  3  February  1990 
3:36:42) . 

You  must  link  the  resulting  object  file  with  the  libraries: 
-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

#include  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 1  =  1; 

static  integer  c _ 2  =  2; 

static  integer  c _ 3  =  3; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 

static  doublereal  dtr  =  .017453292519943296; 

static  doublereal  latlp  =  0.; 

static  doublereal  longlp  =  0.; 

static  real  vpl  =  (float) 13770 . ; 

static  doublereal  tfinal  =  62.501; 

static  real  tstg2  =  (float) 62.5; 

static  real  tst2on  =  (float) 22 . 995; 

static  real  dtcvu  =  (float) 50.; 

/*  System  generated  locals  */ 
real  r_l,  r_2,  r_3; 
doublereal  d_l,  d_2,  d_3; 

/*  Local  variables  */ 

static  doublereal  rmir[3],  vmir[3],  xy2e[3]; 
static  integer  i; 

static  real  t,  delxd,  delyd,  delzd,  tcorv; 
static  doublereal  tstep,  xyzed[3]; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  at[3],  vg[3]; 

extern  /*  Subroutine  */  int  corvel_(),  send_real_32bit _ 0, 

incorv_() , 

vecrot_()  ; 

static  integer  istart; 

static  real  mvrdot; 

static  doublereal  cei[9]; 

extern  /*  Subroutine  */  int  mmk__(); 

static  real  mvr,  mvs,  uvs(3],  vtt[3]; 

/*  initialize  time  */ 
tstep  =  (float) 0 . ; 
t  =  tstep  *  delt; 
for  (i  =  1;  i  <=  3;  ++i)  ( 
xyze[i  -  1]  =  (float) 0.; 
xyzedti  -  1]  =  (float) 0.; 
vtt[i  -  1]  =  (float) 0.; 
vg[i  -  1]  =  (float) 0.; 

/*  LIO:  */ 

} 

xyze[0]  =  (float) 20898908 . ; 
vg[0]  =  (float) 5e3; 
vg[23  =  (float) 9350.; 
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mvrdot  =  (float) 0.; 


- c  */ 

/*  -  missile  state  initialization  module 

- c  */ 

/* 


- c  */ 

/*  initialize  states  and  state  derivatives  */ 
d_l  =  dtr  *  (float) -90 . ; 
d_2  =  latlp  *  dtr; 
d_3  =  longlp  *  dtr; 

mmk_(&d_l,  &c _ 1,  &d_2,  &c _ 2,  &d_3,  &c _ 3,  cei)  ; 

vecrot_(xyzed,  cei,  vmir) ; 

vecrot_(xyze,  cei,  rmir) ; 

incorv_(vg,  rmir,  vmir,  &mvs,  uvs) ; 

mvr  =  vpl; 

tcorv  =  (float) 0 .  ; 

istart  =  0; 

/* 


- c  */ 

/* - main  execution  loop 

- c  */ 

/* 


- c  */ 

L20: 

/* 

*/ 

/*  *  */ 

/*  partition  4  *  */ 

/*  *  */ 

/* 

*/ 

send_real_32bit _ (&mvs) ; 

send_real_32bit _ (uvs) ; 

send_real_32bit _ (&uvs[l]) ; 

send_real_32bit _ (&uvsi2i) ; 

receive_real_32bit _ (at)  ; 

receive_real_32bit _ (&at [1] ) ; 

receive_real_32bit _ (&at [2] ) ; 

receive_real_32bit _ (&delxd) ; 

receive_real_32bit _ (sdelyd) ; 

receive_real_32bit _ (&delzd) ; 

if  (istart  ==  0)  { 


istart  =  1; 
)  else  { 


rmir[0] 

+=  (vmir[0] 

+ 

delxd  * 

.5) 

*  delt; 

rmir [1] 

+=  (vmir[l] 

+ 

delyd  * 

.5) 

*  delt; 

rmir [2] 

+=  (vmir [2] 

+ 

delzd  * 

.5) 

*  delt; 

vmir[0]  +=  delxd; 
vmir[l]  +=  delyd; 
vmir [2]  +=  delzd; 


/*  integrate  performance  velocity  remaining  using  navigation  output 

i(  I 
/ 

if  (t  -  delt  <  tst2on  lit-  delt  >=  tstg2)  { 
mvrdot  =  (float) 0.; 

}  else  { 

/*  Computing  2nd  power  */ 
r  1  =  at [0]  ; 
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/*  Computing  2nci  power  */ 
r_2  =  at  [1]  ; 

/*  Computing  2nd  power  */ 
r_3  =  at[2]; 

mvrdot  =  - (doublereai) sqrt (r_l  *  r_l  +  r_2  *  r_2  +  r_3  *  r  3) ; 

) 

mvr  +=  delt  *  mvrdot; 
if  (mvr  <  (float) 0.)  { 
mvr  =  (float) 0.; 

) 

/*  integrate  gravity  compensated  acceleration  */ 
vtt[0]  +=  delt  *  at(0]; 
vtttl]  +=  delt  *  at  Cl]  ; 
vtt[23  +=  delt  *  atC2]; 

} 

/*  -  correlated  velocity  module 

- c  */ 

if  (tstep  >=  tcorv)  { 

corvel_(&mvr,  &t,  vtt,  rmir,  vmir,  vg,  &mvs,  uvs) ; 
tcorv  +=  dtcvu; 

) 

/* 


*/ 

/*  *  */ 

/*  end  of  partition  4 

* 

j-k  *  * ! 

/* 

*/ 

/*  increment  time  */ 
tstep  +=  (float.)  1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  ( 
goto  L20; 

) 

)  /*  MAIN _ */ 

/*  Main  program  alias  */  int  raain_  ()  {  MAIN _  ();  } 
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A.3.15  Cgl23.c 

/*  cgl23.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


#include  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 20  =  20; 

/*  Main  program  */  MAIN _ {) 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  real  cgz[20]  =  { 

(float)O.,  (float)O.,  (float)O.,  (float)O.,  (float)O., 

(float)  0 . ,  (float)  0. ,  (float)  0 . ,  (float)  0 . ,  (float)  0 . ,  (float)  0  . ,  ( 

float)0.,  (float)O.,  (float)O.,  (float)O.,  (float)O.,  (float)O.,  (float) 

0.,  (float) 0., (float) 0.  }; 

static  real  cg[3]  =  {  (float) 0 .,  (float) 0 ., (float) 0 .  }; 

static  integer  itable  =  0; 

static  real  tfinal  =  (float) 62 . 501; 

static  real  masstl[20]  =  { 

(float)2.403, (float) 2 .468, (float) 2 .524, (float) 

2.724, (float) 3.802, (float) 4 .231, (float) 6.33, (float) 8 . 631, (float) 

11.024,  (float)  13.489, (float) 14 . 932, (float) 17 .2  66,  (float) ]  8 . 955,  ( 

float) 19.457, (float) 22. 121, (float) 25 . 628, (float) 30 , 806,  (float) 
36.5, (float)40.889, (float) 43,939  }; 
static  real  cgx[20]  =  {  (float) -2 . 628, (float) -2 . 628, (float) - 
2.628, (float) 

-2.628,  (float)-3.882, (float) -4 .097, (float)-4.7,  (float) -4 . 987,  ( 
float)-5.176, (float) -5.319,  (float) -5 . 405, ( float) -5 . 451,  (float) 
-5.512,  (float) -5.53,  (float) -6 . 246, ( float) -6 . 857,  (float)- 

7.473,  ( 

float)-7.922, (float)-8.222,  (f loat) -8 . 425  ); 
static  real  cgy[20]  =  { 

(float)O., (float)O., (float)O., (float)O., (float)O., 

(float)O., (float)O., (float)O., (float)O., (float)O., (float)O.,  ( 

float)0., (float)O., (float)O.,  (float)O.,  (float)O.,  (float)O.,  (float) 

0.,  (float) 0., (float) 0.  ); 

static  real  mass,  t; 

extern  /*  Subroutine  */  int  table_(); 

static  real  tstep; 

extern  /*  Subroutine  */  j.nt  receivo_real_32bit _ (), 

3end_real_32bit _ ()  ; 

/*  initialize  time  */ 
tstep  =  (float) 0.; 
t  =  tstep  *  delt; 

LIO: 

send_real_32bit _ (eg)  ; 

send_real_32bit _ (&cgll) ) ; 

send_real_32bit _ (6cg[2] )  ; 

receive  real  32bit  (smass) ; 
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table_ 

(masstl. 

cgx, 

&mass, 

eg,  &c _ 20, 

sitable) ; 

table_ 

(masstl. 

egy. 

&mass, 

&cg[l],  &c _ 

20, 

fiitable) ; 

table_ 

(masstl. 

cgz, 

&mass, 

&cgi2],  &c _ 

20, 

Sitable) ; 

sencl_real_32bit _ (eg)  ; 

send_real_32bit _ (&cg[l] ) ; 

send_real_32bit _ (&cg[2] )  ; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
aoto  LIO; 

} 

}  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  {  MAIN _  () ;  } 
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A.3.16  Cne.c 

/*  cne.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -iI77  -im  -Ic  (in  that  order) 

*/ 

#include  "f2c.h" 

/*  Table  of  constant  values  */ 

static  real  c_b2  =  (float) 4.; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  integer  icnale  =  0; 
static  integer  icnm2e  =  0; 
static  integer  icna2e  =  0; 
static  real  tapu  =  (float) 0.; 
static  real  atapu  =  (float) 5.; 
static  real  tfinal  =  (float) 62 . 501; 
static  real  tstgl  =  (float) 23.; 
static  real  tstg2  =  (float) 62.5; 
static  real  cnale[2053  =  ( 

(float)ll., (float)16., {float)0., (float)5., ( 

float)  10.,  (float)  15.,  (float) 20., (float) 30., (float) 40., (float) 60.,  ( 

float) 80.,  (float) 90., (float) 100., (float) 120., (float) 140., (float) 

160.,  (float) 170., (float) 180., (float) 0.,  (float) 0.,  (float)  .1943, ( 

float) .4861, (float) .6991, (float) 1 . 031, (float) 1 . 8471, ( float) 2 . 8683, 

(float) 5.198, (float) 6.7229, (float) 6 . 9385, (float) 6 . 7289, (float) 

5.1903, (float)2.8804, (float) .8334, (float) .2054, (float)O., (float) 

.5, (float)O., (float) .2016, (float) .4596, (float) .7148, (float) 1 . 0404, 

(float) 1.8189, (float)2.877, ( float) 5 . 1897, (float) 6 . 7274, (float) 

6.9327,  (float) 6.7164,  (float) 5 . 2139,  (float) 2 . 8484,  (float)  .7949,  ( 

float) .2014, (float) 0 . ,  (float)  .  8,  (float) 0 . ,  (float)  .2108,  (float) 
.4888,  (float) .7689,  (float) 1 . 1237,  (float)  1 . 9773, ( float) 3 . 0839,  ( 
float) 5.6104, (float) 7.2627, (float) 7 . 4829, (float) 7 .2585, (float) 

5.6183, (float) 3.0957, (float) .8721, (float) .2244, (float)O., (float) 

.9, (float)O., (float) .2453, (float) .5632, (float) .8506, (float) 1 .2693, 

(float)  2.1842,  (float) 3 . 3373,  (float)  6.0308,  (float) 7 .7796,  (float) 

8.0298,  (float)  7. 7874,  (float) 6 . 0173,  (float)  3 .3226,  (float) .9462,  ( 

float) .2334, (float) 0., (float) 1.1, (float) 0., (float) .259, (float) 
.6233, (float) .9733, (float) 1 . 4721, (float) 2 . 5275, (float) 3 . 9615, ( 
float) 7 .1644,  (float) 9.2488,  (float) 9.5353,  (float)  9.2653,  (float) 

7.1618, (float)  3.9405,  (float) 1 . 1188,  (float) .2778, (float) 0., (float) 

1.2, (float) 0.,  (float) .249, (float) .629, (float) .9901, (float)  1 . 4938,  ( 

float) 2. 7177, (float) 4 .2454, (float) 7 .7199, (float) 9 . 9831, (float) 
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10.2965, (float) 10.0024, (float) 7 .7086, (float) 4 .2635, (float) 1 .2194, ( 

float) .3056,  (float) 0. ,  (float) 1.5,  (float) 0. ,  (float) .2727,  (float) 

.625, (float) 1.0606, ( float) 1 . 6051, ( float ) 2 . 7252, ( float) 4 . 227 9, ( 

float)  7.6637,  (float)  9.9322,  ( f  loat )  10 . 22’’ ;,  ( float)  9 . 9171,  (float) 

7.6573, (float) 4.2184, (fir  t) 1.1961, (float) .3133, (float) 0., (float) 

2.,  (float)O., (float) .2753, (float) .6384, (float)  1 . 1354,  (float)  1 . 664, 

(float)  2.7542,  ( float)  3 . 9459, (float) 7 . 1899, ( float)  9 . 2966, (float) 

9.5868, (float) 9.2911, (float) 7 .2048, (float) 3 . 9474, (float) 1 . 129, ( 

float) .2811, (float) 0 . , (float) 4 . , (float) 0 . , (float) .2656, (float) 
.658, (float) 1.189, (float) 1 . 7299, ( float) 2 . 6718, (float)  3 . 7776,  ( 
float)  6.8236, (float)  8 . 8635,  (float) 9 . 1188, (float) 8 . 8535,  (float) 

6.8525, (float) 3.7561, (float) 1.0696, (float) .2716, (float) 0., (float) 

6., (float)O., (float) .2616, (float) .6025, (float) 1.0334, (float) 

1.4472,  (float)  2 .522,  (float)  3 .7044,  (float)  6.7  629,  (float)  8 . 7381,  ( 

float) 9.012  6,  (float) 8 .7377,  (float) 6.7429,  (float) 3 . 7153,  (float) 

1.0442,  (float) .2684,  (float) 0., (float) 9., (float) 0.,  (float)  .2567,  ( 

float) .615,  (float) 1 .0322, ( float) 1 . 4501, (float) 2 . 5213, (float) 

3.7166, (float) 6.7689, ( float ) 8 . 7283, (float) 9 . 0069, (float) 8 . 7303, ( 

float) 6.7754, (float) 3 .738, (float) 1.0652, (float) .2765, (float) 0. 

) ; 

static  real  cna2e[205]  =  { 

(float)ll., (float)16., (float)O., (float)5.,  ( 

float) 10 . , (float) 15 . , (float) 20 . , (float) 30 . , (float) 40 . , (float) 60 . , ( 
float)80., (float)90., (float)lOO.,  (float)120.,  (float)140.,  (float) 

160. ,  (float) 170., (float) 180. , (float) 0. , (float) 0. ,  (float) . 1526,  ( 

float) .3299, (float) .5186, (float) .7355, (float) 1 .3117, (float) 1 . 7864, 

(float) 2. 6227, ( float) 3 . 3848, (float) 3 . 5119, (float) 3 . 3989, (float) 

2.6088, (float) 1 .4323, (float) .4123, (float) .105, (float)O.,  (float) .5, 

(float) 0., (float) .1466, (float) .324, (float) .5095, (float) .7414,  ( 
float) 1.3098, (float) 1 .8016, (float) 2 . 6256, (float) 3 . 3828, (float) 
3.5111,  (float) 3.3918,  ( float)  2 . 6245,  (float)  1 .  437,  (float)  .4156,  ( 
float)  .lil5,  (float)O.,  (float)  .8,  (float)O.,  (float)  .1389,  (floa*-) 
.3278, (float) .5399, (float) .7499, (float) 1 . 4611,  (float) 2 . 0041,  ( 
float)2.8421, (float) 3 . 6682, (float) 3.796, (float) 3 . 6815, (float) 

2.8486,  (float) 1 . 5607,  (float)  .465,  (float)  .1158,  (float)O.,  (float)  9, 

(float)O., (float) .1547, (float) .3536, (float) .5956, (float) .8675, ( 

float)  1 . 6577, (float) 2 . 1614,  (float)  3 . 0455, (float)  3 . 9357,  (float) 
4.0622,  (float)3.9l95,  (float)  3 . 0225,  (float)  1 . 6694,  (float)  .463,  ( 

float) .1169,  (float) 0.,  (float) 1.1, (float) 0., (float) .1878,  (float) 

.4249,  (float) .6982,  (float) 1 . 001,  (float)  1 . 664  9,  (float) 2 . 3611,  ( 
float)3.619, (float) 4.6821, (float) 4 . 8318, (float) 4 . 6926, (float) 

3.6108, (float)  1 . 4848,  (float) .56,  (float) .1396,  (float) 0., (float) 1.2, 
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(float)O.,  (float) .1929, (float) .4189, (float) .6926,  (f loat) 1 . 0156,  ( 

float) 1.7242, (float) 2. 52 69, (float) 3 . 948, (float) 5 . 0947, (float) 
5.254,  (float)5.103,  (float) 3 . 9517,  (float) 2 . 1728, (float) .6054, ( 

float) .1699, (float) 0 . , (float) 1.5, (float) 0 . , (float) .2014, (float) 

.412,  (float) .748, (float)  1 . 0899, (float)  1 .7873, (float) 2 .5183, (float) 

3.8838, (float) 5.0173, (float) 5 . 1797, (float) 5 . 0229, (float) 3 . 8697, ( 

float)2.1273, (float) .6126, (float) .173, (float)O., (float)2., (float) 

0.,  (float)  1915,  (float) .4388, (float) .7244,  (float) 1.0354, (float) 

1.751,  (float)2.4106,  (float) 3 . 6931,  (float) 4 .774,  (float)  4 . 9262,  ( 
float) 4.7731, (float) 3.7039, (float) 2 . 0259,  (float)  .5808,  (float) 

.1458, (float) 0., (float) 4., (float) 0., (float) .2038, (float) .4157,  ( 

float) .6921, (float; 1.0066, (float) 1 . 6656, (float) 2 . 2891, (float) 

3.4786,  (float)  4.4804,  (float)  4 . 6223,  ( float) 4 . 481,  (float)  3 . 4656,  ( 

float) 1.8978, (float) .5393, (float) .1339, (floac)O., (float)6., (float) 

0., (float) .1866, (float) .3974, (float) .6419, (float)  .9172,  (float) 

1.4828,  (float)  2. 1442, (float) 3 . 4153, (float) 4 . 4316, (float) 4 . 552,  ( 

float) 4.4333, (float) 3 . 4277, (float) 1 . 8834, (float) .5306, (float) 

.1412,  (float) 0., (float) 20., (float) 0., (float) .1656, (float) .3955,  ( 

float) .6324, (float) .8981, (float) 1 . 4796, (float) 2 . 1259, (float) 

3.4177,  (float)  4.4451,  ( float)  4 . 57 63,  ( float)  4 . 4204,  (float)  3 . 4285,  ( 
float) 1.8721, (float) .5357, (float) .149, (float)O.  } ; 
static  integer  icnmle  =  0; 

static  real  t,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (),  tlu2ei_(); 

static  real  estmch; 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

static  real  cne; 

/*  initialize  time  */ 
tstep  =  (float) 0. ; 
t  =  tstep  *  delt; 

LIO: 

receive_real_32bit _ (sestmch) ; 

if  (tstep  >=  tapu)  { 
tapu  +=  dtapu; 
if  (t  <  tstg2)  { 

if  (t  <  tstgi)  ( 

tlu2ei_(&estmch,  &c_b2,  cnale,  &icnmle,  sicnale,  &cne) ; 

}  else  { 

tlu2ei_(&estmch,  &c_b2,  cna2e,  &icnm2e,  &icna2e,  &cne) ; 

) 


) 

send_real_32bit _ (&cne) ; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  t final)  { 
goto  LIO; 

) 

}  /*  MAIN  */ 
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/*  Main  program  alias  */  int  main_  { 


i  MAIN  0;  ) 
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A.3.17  Inerxyz.c 

/*  inerxyz.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  w’th  the  libraries: 

-3E7?  -1177  -Im  -Ic  (in  that  order) 

*/ 


#include  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 20  =  20; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  real  inerzz[20]  =  { 

(float) 3.141,  (fl03t)3.141,  (float) 3 . 141,  (float) 

3.141, (float) 19.068, (float) 20 . 526,  (float) 28 . 074,  (float)  34.176,  ( 

float) 37.873, (float) 40.583, (float) 42.743, (float) 46.409, (float) 

46.883,  (float) 49.315,  ( float ) 136 . 72  6,  (float) 201 . 614,  (float) 261 . 952, 
(float) 310.891, (float) 346.848, (float) 372 . 98  }; 
static  real  ixx  =  (float) 0.; 

static  real  iyy  =  (float) 0,; 

static  real  izz  =  (float) 0.; 

static  integer  itable  =  0; 
static  real  tfinal  =  (float) 62. 501; 
static  real  masstl [20]  =  { 

(float)2.403, (float)  2.468,  (float)  2 . 524,  (float) 

2.724,  (float) 3.802, (float) 4 .231, (float) 6.33, (float) 8 . 631, (float) 

11.024,  (float)  13.489,  (float)  14 . 932,  (float) 17.266,  (f loat )  18 . 955,  ( 

float) 19.457,  (float) 22 . 121,  (float) 25. 628,  (float)  30 . 806, (float) 
36.5, (float) 40.889, (float) 43 . 939  ); 
static  real  inerxx{20]  =  { 

(float) .442, (float) .442, (float) .442, (float) 

.-142,  (float)  1.03,  (float)  1.26,  (float)  2 . 007,  (float)  2 . 723,  (float) 

3.468, (float) 4.109, (float) 4 . 904, (float)5.49, (float) 6.347, (float) 

6.51, (float) 8.169, (float) 9.59, (float) 11.776, (float) 13.174, (float) 

15.196, (float) 16.722  }; 
static  real  ineryy[20]  =  { 

(float) 3.141,  (float) 3.141,  (float) 3.141, (float) 

3. Ml,  (float)  19.063,  (float) 20 . 526,  (floats  28 . 074,  (float)  34 . 176,  , 

float)  37.873, (float)  40.583,  (float)  42.743,  (float)  46.409,  (float) 

16.803,  (float)  li;. 315,  (float)  136.726,  (float)  201 . 614,  (float)  261 . 952, 
(float) 310.891, (float) 346.848, (float) 372 . 98  }; 

static  real  mass,  t; 

extern  /*  Subroutine  */  int  table_(); 

static  real  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (), 

.«cnd  real  32bit  ()  ; 


/*  initialize  time  */ 
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tstep  =  (float)O.; 
t  =  tstep  *  delt; 

LIO: 

senci_real_32bit _ (&iyy)  ; 

receive  real  32bit  (smass); 


table_ 

(masstl. 

inerxx, 

&mass. 

&ixx, 

&c 

20, 

&itable) ; 

table_ 

(masstl. 

ineryy, 

Smass, 

&iyy. 

&c 

"20, 

sitable) ; 

table_ 

(masstl, 

inerzz, 

Smass, 

&izz, 

&c 

'20, 

sitable) ; 

senci_real _32bit _ (&ixx)  ; 

send_real~32bit _ (&iyy) ; 

send_real_32bit _ (&izz)  ; 

/*  increment  time  */ 
tstep  +=  (float) 1 .  ; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

} 

}  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  {)  {  MAIN  ();  ) 
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A.3.18  Press.c 

/*  press. f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42).- 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


♦include  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 59  =  59; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  real  tfinal  =  (float) 62 . 501; 
static  real  altt[59]  =  { 

(float)O., (float)2e3, (float)4e3,  (float)6e3,  ( 

float)  8e3,  (float) le4,  (float) 1 . 2e4, (float) 1 . 4e4, (float) 1 . 6e4,  ( 

float) 1 . 8e4, (float) 2e4, (float) 2 . 3e4,  (float) 2 . 6e4,  (float) 2 . 9e4,  ( 

float) 3 .2e4, (float) 3 . 5e4, (float) 3 . 8e4, (float) 4 . Ie4, (float) 4 . 4e4,  ( 

float) 4.7e4, (float) 5e4, (float) 5.4e4, (float) 5.8e4, (float) 6.2e4,  ( 

float) 6 . 6e4, (float) 7e4, (float) 7 . 4e4, (fxoat) 7 . 8e4, (float) 8 . 2e4,  ( 

float)  8 . 6e4,  (float)  9e4,  (float)  9 . 5e4,  (float)  le5,  (float)  1 .05e5,  ( 

float)  1 • le5,  (float)  1 . 15e5,  (float) 1 .2e5, (float) 1 .25e5, (float) 1 . 3e5, 

(float)  1.35e5,  (float)  1 . 4e5,  (float)  1 . 45e5,  (float)  1 .5e5,  (float) 
1.55e5, (float) 1.6e5, (float) 1 . 65e5, (float) 1 .7e5, (float) 1 .75e5,  ( 

float)  1 . 8e5,  (float)  1 . 9e5,  (float)  2e5,  (float)  2  .  Ie5,  (float)  2 . 2e5,  ( 

float)2.3e5, (f loat) 2 . 4e5, (float) 2 . 5e5, (float ) 2 . 75e5,  (float)3e5, ( 
float)  999999 .-  ); 
static  real  presst[59]  =  { 

(float) 2116.25, (float) 1967.72,  (float) 1827 . 7  8,  ( 

float)  1696.02,  (float) 1571 . 91, (float)  1455 . 35, (float) 1345 . 9,  (float) 

1243.2,  (float)  1147.72,  (float) 1057.49, (float)  973.289,  (float)  857 .2  6, 

(float) 752.725, (float) 658.783, (float) 574 . 592, (float) 499.356, ( 

float) 432. 644, (float) 374 .755, (float) 324 . 623,  ( float) 281 .21,  (float) 

243.614,  (float) 203. 13,  (float)  166 . 178,  (float)  137 .264,  (float) 
113.389, (float) 93.7284, (float) 77 . 5639, (float) 64.2586, (float) 
53.2944, (float) 44.2494, (float) 37 . 1196, (float) 29.2323, (float) 
23.2726, (float) 18.5578, (float)  14.8375,  (float) 11.912,  (float) 
9.60154, (float)7. 76921, (float) 6 . 30961, (float) 5 . 14276, (float) 
4.20625, (float)  3.45183, (float) 2 . 84192,  (float) 2 . 34714,  (float) 
1.94196, (float) 1 . 60687, (float) 1 . 32973, (float) 1 . 10007, (float) 
.908378,  (float) .61551, (float) .413455, (float) .274355, (float) 
.178439,  (float)  .113488,  (float)  ,.070406,  (float)  .042482,  (float) 
.017169, (float) .002643, (float) .002643  ); 
static  integer  itable  =  0; 

static  real  t; 

extern  /*  f^ubroutine  *!  int  table  (); 
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static  real  press,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (), 

send_real_32bit _ ()  ; 

static  real  alt; 

/*  initialize  time  */ 
tstep  =  (float) 0 . ; 
t  =  tstep  *  delt; 
press  =  (float) 0 . ; 

LIO: 

send_real_32bit _ (&press) ; 

receive_real_32bit _ (Salt)  ; 

table_(altt,  presst,  &alt,  &press,  &c _ 59,  &itable) ; 

/*  increment  time  */ 
tstep  +=  (float) 1 . ; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

} 

}  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  {  MAIN _  ();  ) 
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A.3.19  Print.c 

/*  print. f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


#include  "f2c.h" 

/*  Main  program  */  MAIN _ () 

/*  Initialized  data  */ 

static  real  delt  =  (float). 001; 
static  real  tfinal  =  (float) 62 . 501; 
static  real  tprt  =  (float) 0.; 
static  real  dtprt  =  (float) 100.; 

/*  Local  variables  */ 

static  real  velocity,  t,  x,  y,  z,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (); 

static  real  vrwmx,  vrwmy,  vrwmz; 

extern  /*  Subroutine  */  int  send_host_real _ (); 

static  real  garbage,  alt,  phi,  psi,  tht; 

/*  INCLUDE  ' :pfp; include/target . for '  */ 

receive_real_32bit _ (sgarbage) ; 

/*  initialize  time  */ 
tstep  “  (float) 0 . ; 
t  =  tstep  *  delt; 

/* 


- c  */ 

/* - main  execution  loop 

- c  */ 

/* 


- c  */ 

LIO: 

/*  -  receive  parameters  from  partition  #1 

- c  */ 

receive_real_32bit _ (& vrwmx) ; 

receive_real_32bit _ (& vrwmy) ; 

receive_real_32bit _ (Svrwmz) ; 

receive_real_32bit _ (&phi) ; 

receive_real_32bit _ (&tht) ; 

receive_real_32bit _ (&psi) ; 

receive_real_32bit _ (&x) ; 

receive_real_32bit _ (&y) ; 

receive_real_32bit _ (&z) ; 

receive_real_32bit _ (Salt) ; 

if  (tstep  >=  tprt)  { 

velocity  =  sqrt (vrwmx  *  vrwmx  +  vrwmy  *  vrwmy  +  vrwmz  *  vrwmz); 

send_host_real _ (&t) ; 

send_host_real _ (salt) ; 

send_host_real _ (&x) ; 

send_host_real _ (&y) ; 

send_host_real _ (&z) ; 

send_host_real _ (svelocity) ; 

send_host_real _ (& vrwmx) ; 

send_host_real _ (&vrwmy) ; 

send_host_real _ (& vrwmz) ; 

send_host_real _ (&ph: ) ; 
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send_host_real _ (&tht)  ; 

send._host_real _ (&psi)  ; 

tprt  +=  dtprt; 

1 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

) 

)  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main 


0  {  MAIN_  0;  } 
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A.3.20  Rho.c 

/*  rho.f  —  translated  by  f2c  {version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

tinclude  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 59  =  59; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  real  slglbm  =  (float) 32 . 174048; 
static  real  tfinal  =  (float) 62 . 501; 
static  real  altt[59]  =  { 

(float)O,, (float)2e3, (float)4e3, (float)6e3, ( 

float) 8e3,  (float) le4, (float) 1 .2e4, (float) 1 . 4e4,  (float)  1 . 6e4,  ( 

float)1.8e4, (float)2e4, (float) 2 .3e4, (float) 2 . 6e4, (float) 2 . 9e4,  ( 

float)3.2e4, (float) 3 . 5e4,  (float) 3 . 8e4,  (float) 4 . Ie4,  (float) 4 . 4e4,  ( 

float)  4 .7e4,  (float) 5e4,  (float) 5 . 4e4, (float) 5 . 8e4, (float) 6. 2e4,  ( 

float)6.6e4, (float)7e4, (float) 7 . 4e4, (float) 7 . 8e4, (float) 8 .2e4,  ( 

float)8.6e4,  (float)9e4, (float) 9.5e4, (float)le5, (float) 1 . 05e5,  ( 

float) l.le5, (float) 1.15e5, (float) 1 .2e5, (float) 1 .25e5, (float) 1 . 3e5, 

(float) 1.35e5, (float) 1.4e5, (float) 1.45e5, (float) 1.5e5, (float) 
1.55e5, (float) 1.6e5, (float) 1 . 65e5, (float) 1 . 7e5, (float) 1 . 75e5,  ( 

float)  1.8e5, (float) 1 . 9e5, (float)2e5, (float) 2 . Ie5, (float) 2 .2e5,  ( 

float)2.3e5, (float)2.4e5,  (float) 2 . 5e5,  (float) 2 . 75e5, {float)3e5,  ( 
float) 999999.  }; 
static  real  rhot(59]  =  { 

(float)76474., (float)72098., (float) 67917 . , (float) 

63925.,  (float) 60116., (float)  56483 . , (float) 53022 . , (float) 49725 . ,  ( 

float)46589., (float) 43606. , (float) 40773 . , (float) 36790 . , (float) 

33113.,  (float)  29725.,  (float)  26610 . ,  ( float) 23751 . ,  (float) 20794 . ,  ( 

float) 18012 . ,  (float) 15602. ,  (float) 13516. ,  (float)  11709. ,  (float) 

9670.1, (float)  7 987.,  (float) 6597 . 3,  (float)  5448 . 5,  (float)  4478.7,  { 

float) 3685.8, (float) 3036.8, (float) 2504 . 9, (float) 2068 . 5, (float) 

1710.,  (float) 1350., (float)1067.6, { float) 845 . 7, { float) 664 . 7, (float) 

524.12, (float) 415.06,  ( float ) 330 . 06,  (float)  263.53,  (float) 211 .22,  ( 

float) 169.94,  (float)  137 . 22,  (float) 111 . 19,  (float)90.4,  (float) 

74.713, (float) 61.822, (float) 51  159, (float) 4?  605, (float)  35 . 578,  ( 

float)24.663, (float) 16.957, (float) 11.748, (float) 8 . 0356, (float) 
5.3888,  (float)  3.5353,  (float) 2 .263,  (float) .ol"’!,  (float) .1488,  ( 
float). 1488  }; 
static  integer  itable  =  0; 
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static  real  rhod2,  t; 

extern  /*  Subroutine  */  int  table_(); 

static  real  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (), 

send_real_32bit _ ()  ; 

static  real  alt,  rho; 

/*  initialize  time  */ 
tstep  =  (float) 0 .  ; 
t  =  tstep  *  delt; 
rho  =  (float) 0 . ; 

LIO: 

receive_real_32bit _ (Salt)  ; 

table_(altt,  rhot,  salt,  &rho,  &c _ 59,  &itable) ; 

rho  =  rho  *  (float) le-6  /  slglbm; 
rhod2  =  rho  /  (float) 2.; 

send_real_32bit _ (&rhod2) ; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt ; 
if  (t  <  tfinal)  { 
goto  LIO; 

) 

}  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  {  MAIN _  ();  } 
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A.3.21  Shear.c 

/*  shear. f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42) . 

You  must  lin)c  the  resulting  object  file  with  the  libraries: 

-iF77  -1177  -Im  -Ic  (in  that  order) 

*/ 

finclude  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 59  =  59; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  real  tfinal  =  (float) 62 . 501; 
static  real  altt[59]  =  { 

(float) 0. , (float) 2e3, (float) 4e3, (float) 6e3, ( 

float)8e3, (float)le4, (float) 1.2e4, (float) 1 . 4e4, (float) 1 . 6e4,  ( 

float) 1.8e4,  ( float )2e4, (float) 2 . 3e4, (float) 2 . 6e4, (float) 2 . 9e4, ( 

float)3.2e4,  (float) 3 . 5e4,  (float) 3 . 8e4, (float) 4 . Ie4, (float) 4 . 4e4,  ( 

float)  4 . 7e4,  (float)  5e4,  (float)  5 . 4e4,  (float)  5 . 8e4,  (float)  6 . 2e4,  ( 

float)6.6e4,  (float)7e4,  (float)  7 . 4e4,  (floats. 8e4,  (float)  8.2e4,  ( 

float)8.6e4, (float) 9e4, (float) 9 . 5e4, (float) leS, (float) i . 05e5, ( 

float)l.le5,  (float) 1.15e5,  (float) 1 .2e5, (float) 1 . 25e5,  (float) 1 . 3e5, 

(float) 1 . 35e5, (float) 1 . 4e5, (float) 1. 45e5, (float) 1 . 5e5, (float) 
1.55e5, (float) 1 . 6e5, (float) 1 . 65e5, (float) 1 . 7e5, (float) 1 . 75e5, ( 

float) 1.8e5,  (float) 1 . 9e5,  (float) 2e5, (float) 2 . Ie5, (float) 2 .2e5,  ( 

float)2.3e5,  (float) 2 . 4e5,  ( f loat ) 2 . 5e5,  ( f loat ) 2 . 75e5,  (float)3e5,  ( 
float) 999999.  ); 
static  real  sheart(59]  =  { 

(float)O., (float)O., (float)O., (float)O., (float) 

0.,  (float)O., (float)O., (float)O., (float)O., (float)O.,  (float)O., ( 

float)0.,  (float)O.,  (float)O.,  (float)O.,  (float)O.,  (float)O.,  (float) 

0., (float)O., (float)O., (float)O., (float)O., (float)O., (float)O., ( 

float)0., (float)O., (float)O., (float)O., (float)O., (float)O., (float) 

0.,  (float)  0.,  (float)  0.,  (float)  0.,  (float)O.,  (float)  0.,  (float)  0.,  ( 

float)  0. ,  (float)  0.,  (float)  0. ,  (float)  0. ,  (float)  0. ,  (float)  0. ,  (float) 

0.,  (float)O.,  (float)O.,  (float)O.,  (floac)O.,  (float)O.,  (float)O.,  { 

float)0.,  (float)O.,  (float)O.,  (float)O.,  (float)O.,  (float)O.,  (float) 

0  .,  (float)  0 .,  (float )  0  .■  ); 
static  integer  i table  =  0; 

static  real  t; 

extern  /*  Subroutine  */  int  table  (); 
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static  real  shear,  tstep; 

extern  /*  Subroutine  */  int  receive_rfeal_ 

send_real_32bit _ ()  ; 

static  real  alt; 

/*  initialize)  time  */ 
tstep  =  (float) 0 . ; 
t  =  tstep  *  delt; 
shear  =  (3:loat)0.; 

LIO: 

receive_ieal_32bit _ (salt) ; 

table_(altt,  sheart,  &alt,  sshear,  &c _ 59 

send_real_32bit _ (&shear) ; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

} 

}  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  (  MAIN 


32bit _ {) , 


,  sitable) ; 


0  ;  1 
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A.3.22  Target.c 

/*  target. f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


♦include  "f2c.h" 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 
static  doublereal  delt  =  .001; 

static  doublereal  vtic(3]  =  {  -6858 . 46, 0 ., -18411 . 68  ); 

static  doublereal  tfinal  =  62.501; 

static  integer  firstl  =  1; 

static  doublereal  gmu  =  1 . 4052477el6; 

static  doublereal  rtic[3]  =  {  22462673 . 6, 0 ., 3781781 . 71  }; 

/*  System  generated  locals  */ 
doublereal  d_l; 

/*  Local  variables  */ 

extern  /*  Subroutine  */  int  magt_(); 

static  doublereal  mgrt; 

static  integer  i; 

static  doublereal  t,  tdelt,  rortic,  urtic(3),  tstep; 

extern  /*  Subroutine  */  int  mvbys_(),  receive_real_32bit _ {); 

static  doublereal  til,  alt,  grt[3]; 


/* 

-  */ 

!* 

subroutine  : 

target (t, rtic, vtic)  */ 

/* 

*/ 

function  : 

computes  the  rotational  and  translational 

/* 

target  states  */ 

/* 

inputs  : 

t  */ 

/* 

/* 

outputs  : 

rtj.c,vtic  */ 

- */ 

/*  initialize  time  */ 
tstep  =  (float) 0 .  ; 
t  =  tstep  *  delt; 

LIO: 

•eceive_real_32bit _ (salt) ; 

iaagt_(rtic,  &mrtic,  urtic)  ; 

/*  Computing  2nd  power  */ 
d_l  =  mrtic; 

mgrt  =  gmu  /  (d_l  *  d_l); 
d_l  =  -mgrt; 

mvbys_{&d_l,  urtic,  grt); 

/*  integrate  target  acceleration  and  velocity  */ 


^  (firstl  == 

1)  { 

firstl  =  0; 

til  -  t; 

else  { 

tdelt  =  t  - 

til; 

til  =  t; 

for  (i  =  1; 

tl 

V 

•H 
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.5 


/*  L20:  */ 

) 


rtic[i  -  1]  =  rticfi  -  1]  +  vtic[i  -  1]  *  tdelt  - 
*  tdelt  *  tdelt; 

vtic[i  -  1]  +=  grt[i  -  1]  *  tdelt; 


/*  increment  time  */ 
tstep  +=  (float) 1 .  ; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

} 

}  /*  MAIN  */ 


/*  Main  program  alias  */  int  main_  {)  {  M^IN _  ();  ) 


grt[i  -  1]  * 
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A.3.23  Vsnd.c 

/*  vsnd.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  lin)c  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 


#include  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 59  =  59; 

/*  Main  program  */  MAIN _ () 

I 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  real  tfinal  =  (float) 62 . 501; 
static  real  altt[59]  =  { 

(float) 0 . , (float) 2e3, (float) 4e3,  (float) 6e3,  ( 

float) 8e3,  (float) le4, (float) 1 .2e4, (float) 1 . 4e4, (float) 1 . 6e4,  ( 

float)1.8e4,  (float)2e4,  (float) 2 . 3e4,  (float) 2 . 6e4,  (float) 2 . 9e4, ( 

float)3.2e4, (float) 3 . 5e4, ( f loat) 3 . 8e4, ( f loat) 4 . Ie4, (float) 4 . 4e4, ( 

float)  4 .7e4,  (float)  5e4,  (float)  5 . 4e4,  (float)  5 . 8e4,  (float)  6 . 2e4,  ( 

float)6.6e4, (float) 7e4, (float) 7 . 4e4, (float) 7 . 8e4, (float) 8 . 2e4,  ( 

float)8.6e4, (float) 9e4, (float) 9.5e4, (float) le5, (float) 1 .05e5,  ( 

float)l.le5, (float) 1.15e5, (float) 1 .2e5, (float) 1.25e5, (float) 1 .3e5, 

(float) 1 . 35e5,  (float) 1 . 4e5, (float) 1 . 45e5, ( float) 1 . 5e5,  ( float) 
1.55e5,  (float) 1.6e5, (float) 1 . 65e5, (float) 1 .7e5,  (float) 1 . 75e5, ( 

float)1.8e5, (float) 1 . 9e5, (float)2e5, (float) 2 . Ie5, (float) 2 .2e5,  ( 

float)2.3e5, (float) 2 . 4e5, (float) 2 .5e5,  (float) 2 .75e5,  (float)3e5,  ( 
float) 999999.  }; 
static  real  vsndt[59]  =  ( 

(float) 1116.45, (float)  1108.75, ( float ) 1100 . 99,  ( 

float)  1093.19,  (float)  1085.32,  (float) 1077.4, (float)  1069 . 43,  (float) 

1061.39, (float) 1053.3, (float) 1045 . 15, ( float) 1036 . 93, (float) 

1024.48, (float) 1011.89,  (float)  999.14, (float) 986.22,  (float)  973.14,  ( 

float) 968.08, (float) 968.08, (float) 968.08, (float) 968.08, (float) 

968.08, (float)  968.08, (float)  968.08,  (float) 968.08,  (float) 968.19,  ( 

float)  970.9, (float) 973.59, (float)  976. 14, (float) 978 . 95,  (float) 

987.62,  (float) 984.28,  (float) 987.59,  (float) 990.9,  (float) 994.18,  ( 

float) 1002.72, (float) 1011.79, (float) 1020.77, (float) 1029.67, (float) 

1038.48,  (float)  1047.22, (float)  1055 . 88, (float)  1064 . 47, (float) 
1072.99, (float) 1081.43, (float) 1082.02, (float) 1082.02, (float) 
1082.02, (float) 1078.43, (float) 1072.4, (float) 1060.25, (float) 

1047.98,  (float)  1025. 62, (float)  1000. 11, (float)  973 . 96,  (float)  947 . 12, 

(float) 919.5,  (float)  884., (float)  894.5,  (float)  394.5  } ; 
static  integer  itable  =  0; 
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static  real  vsnd,  t; 

extern  /*  Subroutine  *  /  int  table_();' 

static  real  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (), 

send_real_32bit _ () ; 

static  real  alt; 

/*  initialize  time  *! 
tstep  =  (float) 0. ; 
t  =  tstep  *  delt; 

LIO: 

receive_real_32bit _ {&alt) ; 

table_(altt,  sndt,  salt,  svsnd,  &c _ 59,  sitable) ; 

send_real_32bit _ (&vsnd) ; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

) 

)  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  (  MAIN  ();  } 


207 


Appendix  A  -  Exosim  vl.O  Boost  Phase 


A.3.24  Vwind.c 

/*  vwind.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

#inciude  "f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 59  =  59; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 
static  real  tfinal  =  (float) 62 . 501; 
static  real  altt(59]  =  { 

(float) 0. ,  (float) 2e3, (float) 4e3, (float) 6e3,  ( 

float) 8e3, (float) le4, (float) 1 .2e4, (float) 1 . 4e4, (float) 1 . 6e4, ( 

float)  1.8e4,  (float) 2e4, (float) 2 .3e4, (float) 2 . 6e4, (float) 2 . 9e4,  ( 

float)3.2e4,  (float) 3 . 5e4,  (float) 3 . 8e4, (float) 4 . Ie4,  (float) 4 . 4e4,  ( 

float) 4.7e4, (float) 5e4, (float) 5.4e4, (float) 5.8e4, (float) 6.2e4,  ( 

float) 6. 6e4, (float) 7e4, (float) 7 . 4e4, (float) 7 . 8e4, (float) 8 .2e4,  ( 

float)8.6e4, (float)9e4, (float) 9 . 5e4, (float)le5, (float) 1 . 05e5, ( 

float)  l.leS,  (float) 1.15e5, (float) 1 .2e5, (float) 1.25e5, (f loat) 1 . 3e5, 

(float) 1 . 35e5, (float) 1 . 4e5, (float) 1 . 45e5, (float) 1 . 5e5, (float) 

1 . 55e5,  (float)  1 . 6e5,  (float)  1 . 65e5,  (float)  1 . 7e5,  (float)  1 .75e5,  ( 

float) 1.8e5,  (float) 1 . 9e5, (float)2e5, (float) 2 . Ie5, (float) 2 .2e5,  ( 

float)2.3e5, (float) 2 . 4e5, (float) 2 .5e5, (float) 2 .75e5, (float)3e5,  ( 
float) 999999.  1; 
static  real  vwindt(59J  =  { 

(float)O., (float)O.,  (float)O., (float)O., (float) 

0.,  (float)O.,  (float)O., (float)O., (float)O., (float)O.,  (float)O.,  ( 

float)0., (float)O., (float)O., (float)O., (float)O., (float)O., (float) 

0., (float)O,, (float)O., (float)O., (float)O., (float)O., (float)O,, ( 

float)0.,  (float)O., (float)O., (float)O., (float)O., (float)O., (float) 

0 . ,  (float)  0 . ,  (float) 0. , (float) 0 . , (float) 0 . , (float) 0 . ,  (float)  0 . ,  ( 

float)0.,  (float)O.,  (flc  it)0., (float)O., (float)O., (float)O., (float) 

0., (float)O., (float)O., (float)O., (float)O.,  (float)O.,  (float)O., ( 

float)0., (float)O., (float)O., (float)O., (float)O., (float)O., (float) 

0 (float) 0. , (float) 0 .  }; 
static  integer  itable  =  0; 

static  real  t; 

extern  /*  Subroutine  */  int  table  (); 


208 


Appendix  A  -  Exosim  v  1 .0  Boost  Phase 


static  real  vwind,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (), 

send_real_32bit _ ()  ; 

static  real  alt; 

/*  initialize  time  */ 
tstep  =  (float) 0. ; 
t  =  tstep  *  delt; 

LIO: 

receive_real_32bit _ (Salt) ; 

table_(altt,  vwindt,  salt,  svwind,  &c _ 59,  fiitable) ; 

send_real_32bit _ (Svwind) ; 

/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

} 

}  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main_  ()  {  MAIN _  ();  ) 
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A.3.25  Windir.c 

/*  windir.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  linlc  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 

*/ 

tinclude  '’f2c.h" 

/*  Table  of  constant  values  */ 

static  integer  c _ 59  =  59; 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float) .001; 

static  real  dtr  =  (float) .017453292519943296; 

static  real  tfinal  =  (float) 62. 501; 

static  real  altt(59]  =  { 

(float)  0 . ,  (float) 2e3, (float) 4e3, (float) 6e3,  ( 

float)8e3, (float)le4, (float) 1 .2e4, (float) 1 . 4e4, (float) 1 . 6e4,  ( 

float)1.8e4, (float)2e4, (float) 2 . 3e4, (float) 2 . 6e4, (float) 2 . 9e4,  ( 

float) 3 .2e4, (float) 3 . 5e4,  (float) 3 . 8e4, (float) 4 . Ie4,  (float) 4 . 4e4,  ( 

float)4.7e4, (float)5e4, (float) 5 . 4e4, (float) 5 . 8e4, (float) 6 . 2e4,  ( 

float)  6. 6e4,  (float) 7e4, (float) 7 . 4e4, (float) 7 . 8e4, (float) 8 .2e4,  ( 

float)8.6e4, (float)9e4, (float) 9. 5e4, (float)le5, (float) 1 . 05e5,  ( 

float)l.le5, (float) 1 . 15e5, (float) 1 .2e5, (float) 1 .25e5, (float) 1.3e5, 

(float) 1 . 35e5,  (float) 1 . 4e5, (float) 1 . 45e5, (float) 1 . 5e5,  (float) 
1.55e5, (float) 1.6e5,  (float) 1.65e5, (float) 1.7e5, (float) 1.75e5,  ( 

float) 1 . 8e5, (float) 1 . 9e5, (float) 2e5, (float) 2 . Ie5, (float) 2 . 2e5, ( 

float)2.3e5,  (float) 2 . 4e5,  (float) 2 . 5e5, (float) 2 . 75e5,  (float)3e5,  ( 
float) 999999.  ); 
static  real  windirt[59]  =  { 

(float)O., (float)O., (float)O., (float)O., ( 

float)0., (float)O., (float)O., (float)O., (float)O., (float)O., (float) 

0.,  (float)O., (float)O., (float)O., (float)O., (float)O., (float)O.,  ( 

float)  0 . ,  (float)  0 . ,  (float)  0 . ,  (float)  0 . ,  (float)  0 . ,  (float)  0 . ,  (float) 

0. ,  (float) 0 . , (float) 0 . , (float) 0 . ,  (float) 0. , (float) 0 . , (float) 0 . ,  ( 

float)0., (float)O., (float)O., (float)O., (float)O., (float)O.,  (float) 

0., (float)O., (float)O., (float)O., (float)O., (float)O., (float)O.,  ( 

float)©.,  (float)O.,  (float)O.,  (float)O., (float)O.,  (float)O., (float) 

0., (float)O., (fioat)O., (float)O., (float)O., (float)O., (float)O.,  ( 
float)  0 ., (float) 0 ., (float) 0 .  ); 
static  integer  itable  =  0; 

/*  Local  variables  */ 
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static  £eal  t; 

extern  /*  Subroutine  */  rnt  table_(); 
static  real  cwdir,  swdir,  tstep; 

extern  Subroutine  */  int  receive_real_32bit _ (); 

static  real  windir; 

extern  /'  Subroutine  */  int  send_real_32bit _ (); 

static  real  alt; 

/*  initialize  time  */ 
tstep  =  (f.loac)O.; 
t  =  tstep  *  deit; 

LIO: 

receive_real_32bit _ (&alt) ; 

table_(altt,  windirt,  salt,  Swindir,  &c _ 59,  &itable) ; 

swdir  =  sin(windir  *  dtr) ; 
cwdir  =  cos(windir  *  dtr) ; 

send_real_32bit _ (sswdir) ; 

send_real_32bit _ (iowdir)  ; 

/*  increment  time 

tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

} 

)  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main  ()  {  MAIN  () ;  } 
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A.3.26  Xcpe.c 

/*  xcpe.f  —  translated  by  f2c  (version  of  3  February  1990  3:36:42). 

You  must  link  the  resulting  object  file  with  the  libraries: 

-1F77  -1177  -Im  -Ic  (in  that  order) 


♦include  "f2c.h" 

/*  Main  program  */  MAIN _ () 

{ 

/*  Initialized  data  */ 

static  real  delt  =  (float). 001; 

static  integer  icpale  =  0; 

static  integer  icpm2e  =  0; 

static  integer  icpa2e  =  0; 

static  real  ta{.u  =  (float)  0.; 
static  real  dtapu  =  (float) 5.; 
static  real  tfinal  =  (float) 62 .501; 
static  real  tstgl  =  (float) 23.; 
static  real  tstg2  =  (float) 62.5; 
static  real  xcplle(205]  =  { 

(float)ll., (float)16., !float)0., (float)5., ( 

float) 10.,  (float) 15. , (float) 20. , (float) 30.,  (float) 40.,  (float) 60. ,  ( 
float)  80.,  (float)  90.,  (float)  100.,  (float)  120.,  (float)  14  0.,  (float) 

160.,  (float)170., (float)180., (float)O., (float)40.2, (float)55.6,  ( 

float) 59. 4, (float) 58.9, (float) 59.5, (float) 59.3, (float) 62.3, (float) 

67.1, (float)78.8, (float)85.2, (float) 104 . 8, (float) 112 . 6, (float) 

116.8,  (float)  134.4,  (float)  155.8,  (float)  158 . 4,  (float)  .5,  (float) 

42.1,  (float)55., (float)61., (float)57.9, (float)61.2, (float)61.4,  ( 

float)  61.2,  (float) 67.8,  (float) 78. 5, (float) 86.1, (float) 106.5,  ( 

float)115.1, (float) 118.3,  (float) 132 .2, (float) 156.5,  (float)  3  57 . 8,  ( 

float) .8, (float) 41.1, (float)59.9, (float)59.4, (float) 63., (float) 

62.,  (float) 63.4, (float) 63.5, (float) 71. 8, (float) 78.2,  (float) 88.,  ( 

float) 114.1, (float) 125.4, (float) 124., (float) 137.2, (float) 159. ( 

float)161.1, (float) .9, (float)40.3, (float)56.8, (float)62.2, (float) 

63.8, (float) 62.1, (float) 64.4, (float) 65.3, (float) 72. 2, (float) 78.3,  ( 

float) 84.8, (float) 117.8, (float) 125.8, (float) 127 . 7,  ( rloat) 140 . 4,  ( 

float) 166. 9, (float) 175.9, (float) 1.1, (float) 42.1,  (float) 58. 6,  ( 

float)  60.3,  (float)  63.,  (float)  63.5,  (float)  63.8,  (float)  64.5,  (float) 

69.,  (float) 79. 9, (float) 85.7, (float) 123 . 4, (float) 130.3,  (float) 

130.9,  (float) 147.6, (float)188., (float) 197 .5, (float)1.2, (float) 

43.5,  (float) 55.8, (float) 60.3, (float) 63. 6, (float) 63.2,  (float)  63.3,  ( 
float) 68.3,  (float) 74. 2,  (float) 80. 6, (float) 86.,  (float) 127.3,  (float) 

131.4,  (float)  134.,  (float) 152.3,  (float) 189.7, (float) 198.3, (float) 
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1.5,  (float) 43.5,  (float) 57.6,  (float) 59.5, (float) 62.3,  (float) 61.4,  ( 
float)6C.9, (float)72.5, (float)76.9, (float)82.8, (float)85.7, (float) 

95.2,  (float)  101 . 9,  (float)  105 . 4,  (float)  111 .  5,  (float)  147 . 6,  (float) 

160.2,  (float)2.,  (float) 46., (float)59.3, (float) 63.7, (float) 65.4,  ( 
float)67., (float)73.3, (float)75.4, {float)81.2, (float)82.6, (float) 

86.,  (float)  101. 6,  (float)  104.8,  (float)  107 . 8,  (float)  109 . 7,  (float) 

129.6, (float) 145.7.  (float) 4.,  (float) 51.3, (float) 60.2, (float) 68.3,  ( 
float)69.9,  (float)72,l,  (float)77.9,  (float)79.9,  (float)80.9,  (float) 

84.2,  (float) 86.6,  (float) 113.9,  (float) 116.3,  (float) 119.3,  (float) 

121.2,  (float) 125.9, (float) 134 . 9, (float) 6., (float) 52.3, (float) 64.2, 

(float) 66.4, (float) 69., (float) 68., (float)74.3, (float)75.5, (float) 

81.9,  (float)82.5,  (float)86.1,  (float) 117 .2,  (float) 120.7,  (float) 

124.,  (float) 126. 6, (float) 128 . 8, (float) 134 . 4, (float) 9., (float) 50.8, 

(float) 62 . 6,  (float) 66.6, (float) 70.1,  (float) 68.5,  (float) 73.2,  ( 
float) 7  6. 6, (float) 81.3, (float) 83. 3,  (float) 86.4,  (float) 117.3,  ( 
float) 122.6, (float) 125.2, (float) 126., (float) 129. 8, (float) 135.2 

1; 

static  real  xcpl2e(205]  =  ( 

(float)  11.,  (float)  16.,  (float)  0.,  (float)  5.,  ( 

float)10., (float) 15., (float)20., (float)30.,  (float)40.,  (float) 60.,  ( 
float)  80.,  (float)  90.,  (float)  100.,  (float)  120.,  (float)  140.,  (float) 

160.,  (float)170., (float)180., (float)O., (float)33.5, (float)35., ( 
float)35.3, (float)36.4,  (float)36.8, (float)38., (float)37.9,  (float) 

42.4,  (float)45.2,  (float)45.6, (float)52.6, (float)59.,  (float)59.6, ( 
float)59.4,  (float)79.8, (float)82.9, (float) .5, (float)35.2, (float) 

33.4,  (float)33.3, (float)36.4, (float)35.5, (float)38.4, (float)40.4, ( 
float)42.9,  (float)45.4,  (float)47.7, (float)51.4,  (float)57.2,  (float) 

59.3,  (float) 68.1, (float) 80.7, (float) 80.1, (float)  .8, (float) 34.4,  ( 
float) 34.8, (float) 35.1, (float) 36. 6, (float) 38.5, (float) 40.3, (float) 

41.4,  (float)43.5, (float)46.6, (float)47.6, (float)53.5, (float)63.1, ( 
float)63.5, (float)71.1, (flOac)80.3, (float)83.7, (float) .9, (float) 

35.7, (float) 36., (float) 35.1, (float) 35.8, (float) 38.2, (float) 40.9, ( 
float) 42.8, (float) 44.3,  (float) 4  6.7, (float) 45.8,  (float) 53. 6,  (float) 

65.1, (float) 67.,  (float) 71.7, (float) 86.8, (float) 90. 6,  (float) 1.1,  ( 
float) 37. 9,  (float) 38. 6, (float) 36. 4, (float) 37.4, (float) 38. 4,  (float) 
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41.2,  (float) 43.6, (float) 42.8, (float) 43.6, (float) 47.9, (float) 56.7, ( 
float) 67.4, (float) 67.6, (float) 77., (float) 96.2, (float) 102 . 6, (float) 

1.2,  (float) 36.7, (float) 35.1, (float) 36.5, (float) 35., (float) 40.,  ( 
float) 41.7, (float) 41.1, (float) 43., (float) 46.7,  (float) 47.7,  (float) 

59.2,  (float)66.5, (float)67.6, (float)80., (float)97.9, (float) 102 .7, ( 
float)1.5, (float)34.7, (float)35.2, (float) 36 . ^ , (float)39.5, (float) 

40.5,  (float) 40. 9,  (float) 41.7, (float) 45., (float) 45.7,  (float) 47.5,  ( 

float) 49.5, (float) 53.5, (float) 55.5, (fxoat) 59.3, (float) 75.8, (float) 

82.4,  (float)  2.,  (float) 35.,  (float) 36.1, (float) 37.,  (float) 38.4,  ( 

float) 40.5, (float) 41., (float) 41., (float) 44.4, (float) 45.5, (float) 

47.6,  (float)52.6,  (float)54.3,  (float)55.6,  (float)58.,  (float) 67.3,  ( 
float)76.5, (float)4., (float)33.7, (float)36.4, (float)37.3, (float) 

39.7,  (float) 41., (float) 43. 6, (float) 41.5, (float) 44.4, (float) 45.7,  ( 
float) 46.4,  (float) 53.8,  (float) 60.6, (float) 60.8, (float) 62.8,  (float) 

65.2,  (float) 70., (float) 6., (float) 37.8, (float) 36.2,  (float) 37.6,  ( 

float) 39. 9, (float) 39. 6, (float) 42.2, (float) 43. 4, (float) 43., (float) 

46.9, (float)48.7, (float)54.3, (float)62.4,  (float)65.1,  (float)64.3,  ( 

float)68.2, (float)70.5, (float)20., (float)35., (float)36.1, (float) 

37  9,  (float) 39.5, (float) 40.3, (float) 40.7, (float) 42.,  (float) 42.5,  ( 

float)46.8,  (float)48.7,  (float)52.8, (float)62.,  (float)64.5,  (float) 

65.1, (float) 67.2, (float) 68.8  }; 
static  integer  icpmle  =  0; 

static  real  xcpe,  t,  tstep; 

extern  /*  Subroutine  */  int  receive_real_32bit _ (),  tlu2ei_(); 

static  real  alfate,  estmch; 

extern  /*  Subroutine  */  int  send_real_32bit _ (); 

/*  initialize  time  */ 
tstep  =  (float) 0 . ; 
t  =  tstep  *  delt; 

LIO: 

receive_real_32bit _ (fiestmch) ; 

receive_real_32bit _ (salfate)  ; 

if  (tstep  >=  tapu)  { 
tapu  +=  dtapu; 
if  (t  <  tstg2)  ( 

if  (t  <  tstgl)  { 

tlu2ei_(&estmch,  salfate,  xcplle,  sicpmle,  &icpale,  &xcpe) ; 

}  else  { 

tlu2ei_(&estmch,  salfate,  xcpl2e,  &icpm2e,  &icpa2e,  &xcpe) ; 

) 

} 

} 

send_real_32bit _ (Sxcpe) ; 
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/*  increment  time  */ 
tstep  +=  (float) 1.; 
t  =  tstep  *  delt; 
if  (t  <  tfinal)  { 
goto  LIO; 

} 

)  /*  MAIN _  */ 

/*  Main  program  alias  */  int  main 


{  MAIN  0;  } 
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A.4  Crossbar  Code 


boost2a 

is  boost2a.fpx 

on 

xl3 

boost2al 

is 

boost2al . fpx 

on 

xl4 

boost2a3 

is 

boost2a3 . fpx 

on 

xl5 

boost2c2 

is 

boost2c2 . fpx 

on 

yll 

boost2b 

is  boost2b.fpp 

on 

xO 

boost2c 

is  boost2c.fpp 

on 

xl 

attlm 

is 

attlm. fpp 

on 

x2 

cgl23 

is 

cgl23 . fpp 

on 

x3 

inerxyz 

is  inerxyz . fpp 

on 

x4 

cne 

is  cne . fpp 

xepe 

is 

xepe . fpp 

on 

x6 

press 

is 

press. fpp 

on 

x7 

vsnd 

is 

vsnd. fpp 

on 

x8 

rho 

is  rho . fpp 

vwind 

is 

vwind. fpp 

on 

xlO 

windir 

is  windir. fpp 

on 

xll 

shear 

is 

shear . fpp 

on 

xl2 

boost2a2 

is 

boost2a2 . fpp 

on 

yO 

aeroca 

is  aeroca . fpp 

on 

yi 

aerocn 

is  aerocn. fpp 

on 

y2 

aeroxcp 

is  aeroxcp. fpp 

on 

y5 

boost2cl 

is 

boost2cl . fpp 

on 

y9 

bauto 

is 

bauto . fpp 

on 

ylO 

boost2bl 

is 

boost2bl . fpp 

on 

yl2 

print 

is 

print . fpp 

on 

yl3 

timer 

is 

timer . fpp 

on 

yl5 

cycle  timer. 

.2 [garbage] 

— >  print; 

on  x5 


on  x9 


loop 


[0:] 

cycle  cgl23.2 [cg(l) ] 
boost2bl  timer; 
cycle  cgl23 .2 [eg (2) ] 
boost2bl  timer; 
cycle  cgl23.2 [cg(3) ] 
boost2bl  timer; 
cycle  press . 2 [press] 

[cycle]  boost23l .2 [mach] 
cycle  boost2al .2 [qa] 

[cycle]  boost2a3 .2 [p] 

[10;] 

cycle  boost2a3 .2 [q] 
cycle  boost2a3 .2 [r] 
cycle  boost2a .2 [ud] 
cycle  boost2a .2 [vd] 
cycle  boost2a .2 [wd] 

[20:] 

cycle  boost2a3 .2 [pd] 
cycle  boost2a3 .2 [qd] 
cycle  boost2a3 .2 [rd] 

[cycle]  boost2a .2 [gr (1) ] 
cycle  boost2a .2 [gr (2) ]  — > 

cycle  boost2a .2 [gr (3) ]  — > 

[30:] 

cycle  boost2c2 .2 [mvs] 
cycle  boost2c2 .2 [uvs (1) ] 
cycle  boost2c2 .2 (uvs (2) ] 


— >  boost2b  boost2cl  bauto 

— >  boost2b  boost2cl  bauto 

— >  boost2b  boost2cl  bauto 

— >  boost2bl  timer; 

— >  boost2b  [timer] ; 

— >  boost2b  timer; 

— >  boost2cl  [timer] ; 

— >  boost2cl  timer; 

— >  boost2cl  timer; 

— >  boost2cl  timer; 

— >  boost2cl  timer; 

— >  boost2cl  timer; 

— >  boost2cl  boost2a2  timer; 

— >  boost2cl  boost2a2  timer; 

— >  boost2cl  boost2a2  timer; 

— >  boost2c  [timer] ; 

boost2c  timer; 
boost2c  timer; 

— >  boost2c  timer; 

— >  boost2c  timer; 

— >  boost2c  timer; 
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cycle  boost2c2 .2 (uvs (3) ] 


cycle  boost2c.2 [at  (1) ]  — > 

[40:] 

cycle  boost2c.2 [at (2) ]  — > 

cycle  boosu2c.2 [at (3) ]  — > 

cycle  boost2c.2 [delxd]  — > 

cycle  boost2c.2 [delydj  — > 

cycle  boost2c.2 [delzd]  — > 

[cycle]  inerxyz .2 [iyy] 

[50:] 

cycle  boost2a.2 [alt] 


cycle  boost2al .2 [vrwm(l) ] 
cycle  boost2al . 2 [vrwm (2) ] 
cycle  boost2al .2 [vrvmi(3) 1 
[cycle]  boost2a.2 [mass] 

[timer] ; 

cycle  boost2a.2 [alt] 
shear  timer; 

[60:] 

cycle  boost2a . 4 [xyz (1) ]  — > 

cycle  boost2a . 4 [xyz (2 ) ]  — > 

cycle  boost2a.4 [xyz (3) ]  — > 

cycle  boost2a.4 [xyzd(l) ] 
cycle  boost2a.4 [xyzd(2) ] 

[80:] 

cycle  boost2a.4 [xyzd(3) ] 
cycle  boost2a2 . 2 [cim(l) ] 
timer; 

cycle  boost2a2 .2 [cim(2) ] 
timer; 

cycle  boost2a2.2 [cim(3) ] 
timer; 

[90:] 

cycle  boost2a2 .2 (cim(4) ] 
timer; 

cycle  boost2a2 . 2 [cim(5) ] 
timer; 

cycle  boost2a2 .2 [cim(6) ] 
timer; 

cycle  boost2a2 .2 [cim(7) ] 
timer; 

cycle  boost2a2 .2 [cim(8) ] 
timer; 

[100:] 

cycle  boost2a2 .2 [cim(9) ] 
timer; 

cycle  boost2a2 .2 [phi] 
cycle  boost2a2 .2 [tht] 
cycle  boost2a2 .2 [psi] 

cycle  boost2bl.2 [fxt] 

[cycle]  vwind.2 [vwind] 

[110:] 

cycle  boost2bl .2 [fyt] 

[cycle]  shear. 2 [shear] 
cycle  boost2bl .2 [fzt] 

[cycle]  windir.2 [swdir] 
cycle  boost2bl .  2  [m_xt] 

[cycle]  windir .2 [cwdir] 

[110:] 

cycle  boost2bl .2 [myt] 
cycle  boost2b] .2 [mzt] 

[120:] 


— >  boost2c  timer; 

boost2c2  timer; 

boost2c2  timer; 
boost2c2  timer; 
boost2c2  timer; 
boost2c2  timer; 
boost2c2  timer; 

— >  bauto  [timer] ; 

— >  bauto  timer; 

— >  bauto  print  timer; 

— >  bauto  print  timer; 

— >  bauto  print  timer; 

— >  cgl23  inerxyz  boost2a3 

— >  press  vsnd  rho  vwind  windir 


boost2al  boost2a3  timer; 
boost2al  boost2a3  timer; 
boost2al  boost2a3  timer; 


— > 

— > 

boost2al 

boost2al 

timer; 

timer; 

— > 

— > 

boost2al 

boost2al 

timer; 

boost2a 

boost2a3 

— > 

boost2al 

boost2a 

boost2a3 

— > 

boost2al 

boost2a 

boost2a3 

— > 

boost2al 

boost2a 

boost2a3 

— > 

boost2al 

boost2a 

boost2a3 

— > 

boost2al 

boost2a 

boost2a3 

— > 

■boost2al 

boost2a 

boost2a3 

— > 

boost2al 

boost2a 

boost2a3 

— > 

boost2al 

boost2a 

boost2a3 

— >  print  timer; 

— >  print  timer; 

— >  print  timer; 

— >  boost2a  boost2a3  timer; 

— >  boost2al  [timer] ; 

— >  boost2a  boost2a3  timer; 

— >  boost2al  [timer]; 

— >  bocst2a  boost2a3  timer; 

— >  boost2al  [timer] ; 

— >  boost2a3  timer; 

— >  boost2al  [timer] ; 

— >  boost2a3  timer; 

— >  boost2a3  timer; 
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cycle  boost2b . 2 [ f rex] 
cycle  boost2b . 2 [ f rcy] 
cycle  boost2b.2 [frez] 

[120:] 

cycle  boost2b.2 [mrex] 
cycle  boost2b.2 [mrcy] 

[130:] 

cycle  boost2b.2 [mrez] 

[cycle]  boost2bl .2 [mdott] 
cycle  boost2b.2 [mdotf]  — > 

[cycle]  boost2cl .2 [delphi] 


cycle  boost2cl .2 [deltht] 

[130:] 

cycle  boost2cl .2 [delpsi] 
cycle  boost2cl .2 [delu]  — > 

[140:] 

cycle  boost2cl .2 [delv]  — > 

cycle  boost2cl . 2 [delw]  — > 

[cycle]  bauto.2  [cmmdd)  ] 
cycle  bauto.2 [emmd (2) ]  — > 


[140:] 

cycle  bauto . 2 [dlpc] 
cycle  bauto.2 [dlyc] 

[150:] 

cycle  bauto.2  [sq] 
cycle  bauto.2 [sr] 
cycle  bauto.2 [mdltfr] 

[150:] 

cycle  bauto.2 [malpha] 
cycle  bauto.2 [estmeh] 

[160:] 

cycle  bauto.2 [alfate] 
cycle  cne.2[cne] 
cycle  xcpe.2[xcpe] 

[cycle]  boost2c.2 [pm(l) ] 

[160] 

cycle  boost2c.2 [pm(2) ]  — > 

cycle  boost2c.2  [pin(3)  ]  — > 

[cycle]  cgl23.2 [cg(l) ] 

[170:] 

cycle  cgl23 .2 [eg (2) ] 
cycle  cgl23 . 2 [eg  (3) ] 
cycle  inerxyz.2 [ixx] 

[170:] 

cycle  inerxyz .2 [iyy] 
cycle  inerxyz .2 [izz] 

[180:] 

cycle  vsnd.2[vsnd] 
cycle  boost2al .2 [mach]  — > 

cycle  boost2al .2 [alfat]  — > 

[180:] 

cycle  rho . 2 [ rhod2 ] 
cycle  aeroca.2[ca] 

[190:] 

cycle  aerocn.2[cn] 
cycle  boost2al .2 [fxa] 
cycle  boost2al .2 [fya] 

[190:] 

cycle  boost2al .2 [fza] 

Cycle  deroxcp.2 [xcp] 

[cycle]  attlm.2 [attlm] 

[200:] 

cycle  boost2c.2 [psier]  — > 

cycle  boost2c.2 [thter]  — > 


— >  boost2a  boost2a3  timer; 

— >  boost2a  boost2a3  timer; 

— >  boost2a  boost2a3  timier; 

— >  boost2a3  timer; 

— >  boost2a3  timer; 

— >  boost2a3  timer; 

— >  boost2a  [timer] ; 

boost2a  timer; 

— >  boost2c  [timer]; 

— >  boost 2c  timer; 

— >  boost2c  timer; 
boost2c  timer; 

boost2c  timer; 
boost2c  timer; 

— >  boost2bl  [timer] ; 

boost2bl  timer; 

— >  boost2b  timer; 

— >  boost2b  timer; 

— >  boost2b  tim.er; 

— >  boost2b  timer; 

— >  boost2b  timer; 

— >  boost2b  timer; 

— >  cne  xepe  timer; 

— >  xepe  timer; 

— >  bauto  timer; 

— >  bauto  timer; 

— >  boost2b  [timer]; 

boost2b  timer; 
boost2b  timer; 

— >  boost2a3  [timer] ; 

— >  boost2a3  timer; 

— >  boost2a3  timer; 

— >  boost2a3  timer; 

— >  boost233  timer; 

— >  boost2a3  timer; 

— >  boost2al  timer; 

aeroca  aerocn  aeroxcp  timer; 
aeroca  aerocn  aeroxcp  timer; 

— >  boost2al  timer; 

— >  boost2al  timer; 

— >  boost2al  timer; 

— >  boost2a  boost2a3  timer; 

— >  boost2a  boost2a3  timer; 

— >  boost2a  boost2a3  timer; 

— >  boost2a3  timer; 

— >  boost2c  [timer] ; 

bauto  timer; 

bauto  timer; 
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cycle  boost2c.2 [sq] 

— > 

bauto  timer; 

[200] 

cycle  boost2c.2 [sr] 

— > 

bauto  timer; 

[cycle]  boost2a.2[x] 

— > 

print  [timer]; 

cycle  boost2a.2[y] 

— >  print  timer; 

[210:] 

cycle  boost2a.2[2] 

— >  print  timer; 

cycle  boost2a .2 [alt] 

— > 

print  timer; 
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DTIC 


